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ABSTRACT 





A Point Defense Missile Simulation has been developed. This report describes 
the concept of such a missile, the basic features of the simulation program 
including the integration routine and the jet reaction controllers, and pro- 
vides a FORTRAN coded source program. 
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INTRODUCTION 



A POint DEfense Missile Simulation (PODEMS) program has been developed 
and this report offers a description of its basic features, structure, and 
requirements. Although rather straight forward in nature, this program 
provides the basic framework from which further simulations of increased 
complexity and sophistication can be easily implemented. 

The concept of a point defense missile as defined by this effort can be 
best understood by analyzing a typical flight. The seeker of the missile 
initially acquires a low-altitude, high speed, incoming target. The surface- 
to-air missile launches vertically, and then immediately performs a rapid 
pitch-over maneuver toward the target with a consequent altitude gain of less 
than 500 feet. The primary controllers for this phase of the flight are two 
pairs of diametrically opposed jets (jet reaction controllers -JRC) aligned 
perpendicular to both one another and the missile axis of symmetry. Upon 
attainment of an approximately horizontal flight path, the primary controller 
of the missile transfers to typical aerodynamic surfaces (CANARDS) which then 
guide the missile to intercept. The maneuvers of lift-off and pitch-over, for 
which the time frame is 1. -1.5 secs, are of primary interest and therefore 
are the object of this simulation. 

The important features of the simulation are: acceptance of a vertical 

launch configuration, implementation of JRC controlled maneuvers, a detailed 
simulation of a large-look angle seeker, and a dual speed integration routine. 

The basis of the simulation is a dual speed integration routine using 
Hamming's predictor -modifier-corrector formulation for the recursion equations. 
The user has the option of specifying which state variables are integrated with 
the two different steps size h and h g . Additionally, because of the 
singularities evident in the Euler angles , four quaterion parameters are 
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employed to uniquely represent the missile attitude for all possible 
orientations . 

All of the missile parameters, including the aerodynamic data for both 
the baseline missile and the JRC's, are listed •within the report. However, 
the reader is cautioned against the assumption that a particular missile is 
being simulated for the data are only representative of this type of missile. 

The intention of this effort was to provide a general basic structural 
program capable of simulating a missile as a rigid body with the specific 
subroutines for the aerodynamic data, rigid body parameters, etc. to be 
supplied by the user as required. 
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COMPUTER PROGRAM EXPLANATIONS 

A . Definitions of Coordinate Systems 

1. Inertial Coordinate System 

An inert ially fixed coordinate system (X,Y,Z) is attached to the 
earth with the origin at ground zero, the X axis indicating north, the 
Y axis indicating east and the Z axis indicating the local vertical (positive 
downward ) . 

2. Missile Fixed Coordinate System 

A body fixed coordinate system (x,y,z) is located with its origin at 
the missile center of gravity, the x axis as the missile's axis of symmetry 
(positive pointing forward), the y axis rotated negative 45° from the right- 
hand pitch canard, and the z axis rotated accordingly. See Figure 1. 

3. Pitch Axis Coordinate System 

The origin and the x' axis of the pitch axes coordinate system 
(x',y',z') are coincident with their counterparts in the missile fixed axes 
system, while the z' axis always coincides with the projection of the 
relative wind vector onto the y , z plane. The angle $ indicates the 
relative rotation of (x',y',z') with respect to (x,y,z). See Figure 2. 

B. Missile Position and Orientation 

The coordinates X , Y , HT locate the missile center of gravity with 
respect to the inertial coordinate system in the north-south, east-west, 
and height above ground zero directions respectively. 

The orientation of the missile axes with respect to the inertial system 
is monitored using the standard Euler angles 1 Y > 0 > $ (yaw, pitch, roll) 
with the order of rotation as given. The resulting transformation matrix 
from inertial coordinates to missile coordinates is 
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X 




Til 


T12 


T13 


y 


= 


T21 


T22 


T23 


z 




T31 


T32 


T33 



where 
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Y cos 


9 
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sin 
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- sin 
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sin 
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$ 














T31 


= 


cos 
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sin 
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sin 
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sin 
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sin 
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cos 
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cos 
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sin 


T33 
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cos 
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cos 
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In the actual simulation, the Euler angles are not employed because of their 
singularity at 9 = + 90 . ; however they are calculated and outputed to aid 
the program user in visualization of the missile orientation. The following 
equalities define the Euler angles when 9 / + 90 .: 

9 = sin -1 (-T13) 

Y = tan”'*' (T12/T11) (4 quadrant tan *") 

$ = tan” 1 (T23/T33) (4 quadrant tan” 1 ) 

However, when 9 = + 90. , Y and $ are undefined and the following con- 
vention is adopted 

Y = 0 



§ = tan” 1 (T21, T3l) (4 quadrant tan” 1 ) 
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p 

C . Quaterions 

To avoid the singularity of the Euler angles at 9 = + 90* the quaterion 
system of four coordinates is adopted. The introduction of an extra coordinate 
into the system removes the singularity hut requires the addition of a con- 
straint equation on the four parameters . 

2 2 

The four coordinates are e^, 6 ^, 62*63 with the constraint of e^ + + 

2 2 

e 2 + e g =1 (orthogonality). The elements of the previously mentioned 
transformation matrix are functions of these coordinates . 



Til 

T12 

T13 

T21 

T22 

T23 

T31 

T32 

T33 



2 2 2 
e 0 +e l e 2 



2 (e l e 2 + e 0 e 3 ) 



2 (e l e 3 - e 0 e 2 ) 
2 (e l e 2 ' e 0 e 3 ) 



2 2 2 
6 0 + e 2 “ e i 



2( e 2 e 3 + e^) 



2( e i e 3 + e 0 e 2 ) 



2( e 2 e 3 - e o e i) 



2 2 2 
e 0 + e 3 “ e l 



e 



2 

3 



e 



2 

3 



2 



e 



2 



The differential equations for the quaterion parameters as functions of 
the missile angular rates (p,q,r) are: 
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e Q = - i ( e jP + e 2 q + e^r) 

^ = 2 ( e 0 P - e q + e^) 

e 2 = i (e 3 P + e Q q - e^r) 

e 3 = 2 (- e 2 p + e x q + e Q r) 

Mechanization of the constraint equation is achieved by defining an error 

2 2 2 2 
e = 1 - (e Q + e^^ + e 2 + e 3 ) 

which is a measure of the violation of the constraint and applying a correction 

factor to each differential equation which reduces the error. With a value of 

-6 

K = 1 the equations remain correctly constrained within | e | £ 10~ . 

e Q = - i ( e x P + e 2 q + e 3 r) + Ke Q e 

^ = i (e Q p - e 3 q + e 2 r) + Ke 1 e 

e 2 = i (e 3 P + e Q q - e^r) + Ke 2 e 

e 3 = \ (- e 2 p + e x q + e Q r) + Ke^ 

The required initial conditions on e^ , e^ , e 2 , e 3 are given as 
functions of the initial Y , 9 , § by 

e Q = cos (y/2) cos (9/2) cos (§/2) + sin ( y/ 2 ) sin ( 0/2 ) sin (f/2) . 

e^ = cos (Y/2) cos (0/2) sin ($/2) ~ sin (y/ 2) sin (9/2) cos (§/2) 

e 2 = cos (y/2) sin ( 0/2 ) cos ($/2) + sin (y/2) cos (g/2) sin (§/2) 

e 3 = - cos (Y/2) sin (9/2) sin (§/2) + sin (V 2 ) cos ( 0/ 2 ) cos (§/2) 
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D. Differential Equations for Rigid Body 



With Xp , Yp, , Zp, defined as the total forces on the missile expressed 
in missile axes x,y,z respectively and X^ > Y M > Z M defined as the total 
moments about the missile center of gravity expressed in the same axis system, 
the differential equations of motion are: 



u 

v 

w 

P 

k 

r 



rv - qw + Xy/m 
pw - ru + Yp/m 
qu - pv + Zp/m 



X 



M 



pr (I - I ) + Y v 
v x y M 



. ^ (l x ~ T y^ + Z M 

x y 



X- 




- 




~ ~ 


I 








u 


• 




m -l 






y i 




T 




V 


• 










HT 








-w 



Sq = “ 2 (e^P + e 2 q + e 3 r) + Ke Q e 

e 2 = i (e Q p - e^q + e 2 r) + Ke^ 

e 3 = i (e^p + e Q q - e^r) + Ke 2 e 

64 ■ i (- e 2 p + e^q + e Q r) + Ke^e 



It is assumed that the missile is symmetric about the 



products of inertia exist and 1=1. 

y z 

formation matrix from (X,Y,Z) to (x,y,z) 



-1 T 

T = T where 



x axis, no cross 
T is the trans- 
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E. Definition of the Relative Wind Orientation 



Two angles a and define the orientation of the relative wind vector 

with respect to the missile axis system as shown in Figure 3, where u^ , v^, , 
w^, are the x,y,z components of the resultant wind and V = (u^, +v^, +w^, ) 2 . 
Along each axis the resultant wind component is the difference of the missile 
inertial velocity and the true wind for that axis. 

"T = U - U w 






= w - w 



w 



Additionally, defines the orientation of the resultant wind with 

respect to each individual JRC (Jet Reaction Controller). Positive § is 

J 

defined as shown in Figure 4. 

F. Aerodynamic Data 

The missile aerodynamics are divided into two distinct categories: (l) aero- 

dynamic coefficients for the baseline missile (no JRC) and (2) amplification 
factors which represent the effect of the JRC thrusters. Both sets of data are 
functionally dependent on a and either ^ or but not on Mach number . 

The baseline aerodynamic coefficients C,,C,,C,,C.,,C,,C, 

x y z jc m n 

are given as shown in Figures 5-6. For the present simulation C^i = C^, = C^ t = 

C , = 0 . 

n' 

The effects of the JRC thrusters are summarized by amplification factors 
as follows ( y force and moment amplification factors are used as examples ) 



- Y- 



K = 

y 



F I 

'JRC on 'JRC off 

T 

JRC 



■M 



K = 
m 



JRC on 



y m| 



JRC off 



T JRC (x JRC^ 
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The specific values of K , , K m , K n as programmed are shewn in 

Figures 7-8. For this simulation K = K = 0 . Additionally, the effects 

y ^ 

of the JRC jets are assumed to be independent. 

G. Integration Routine ^ 

Hamming's predictor, modifier, corrector set of recursion equations are 
used for the dual speed numerical integration of the problem state variables . 
The following is a brief explanation of the equations . 

For a system of n ordinary differential equations 



where 



y' = f (x,y ) 



y' = dy/dx , 



a sequence of the solution variables 



y i = y ( x i) 1 = 2 j • 



can be expressed as a function of previous y^ and y^ t . With 



h = x. , - x. Hammings method is: 
l+l i 



PREDICT : 



P i+1 y i-3 + 3 ^ 2y i " y i-l + 2y i-2^ 



MODIFY: 



112 , x 

m i+l P i+1 " 121 ( p i " c i 



m i+l = f (x i+l ’ m i+l ) 



CORRECT: 



C i+1 = \ [9y i “ y i-2 + 3h (m i 



i+1 



+ 2y!^ - y£_ x )] 



FINAL VALUE: 



y i+l C i+1 + 221 ^ P i+1 



C i+1 } 
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Each advance of h in the independent variable x requires two evaluations 
of y' , once for the predictor and once for the corrector. The method is 
numerically stable with truncation errors to the order of h^ . 

The values of y and y' from the past three intervals are necessary, 
thus a starting technique is required. The conventional application of a 
4th order Runge-Kutta integration method on the first three steps was dis- 
carded in favor of calculating the required state variables by a Euler back- 
step. Specifically, for i = 0 ,- 

y_ 3 - y 0 - 3hy^ 

y _ 2 - y 0 - 
y.i - y 0 - h y o 
y '.2 = = y ' 0 

This method suffers from inaccuracy when y'^ and y' differ appreciably 
from y^ . However, in this simulation, no variation in the solution was 
detected from the application of the less accurate Euler backstep when com- 
pared with a Runge-Kutta starter. 

An additional complexity was introduced by the requirement of a dual 
speed integration algorithm because of computational time considerations. 

Now -there are two systems of differential equations: 

y' = f (x,y, z ) 
z’ = f (x,y,z) 

with the z equations requiring smaller time steps than the y equations 

for the same accuracy criteria. With h and h defined as the smaller 

s 
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and larger step sizes respectively, figure 9 depicts the sequencing of the 

algorithm for- one step of h . A ratio of h /h = 5 is chosen for illustra- 

s s 

tion although this is variable at the operator's option. 

H. Other Subroutines 
CONTROL SYSTEM 

The <IRC's were assumed to be the primary controlling elements for the 
initial missile trajectory and, therefore, the canard deflection are identically 
zero for this phase of the flight. 

Two control equations govern the action of the JRC's, one for each pair 
of opposing jets. Figure 10 defines the jet numbers and orientations. For 
illustration the control of jets 1 and 3 is presented. A variable FRMTZ is 
defined as a function of missile-target relative position and rates. The 

exact specification for this equation is the operators responsibility. When 
FRMTZ > 0 jet 3 is on while jet 1 is off. If FRMTZ < 0 the reverse 
is true, and when FRMTZ = 0 both jets are off. 

As an example of a possible control equation consider 

FRMTZ = a A + K a A 

where cr^ is defined in Figure 11. 

SEEKER 

This program incorporates a simulation of a large look angle version of a 
present day seeker. The simulation was supplied by the manufacturer and was 
only slightly modified to interface correctly. The system description will 
not be discussed here, only the inputs and outputs of the subroutine. 

The following information is required by subroutine SEEKER: , Y^ , HT , 

XTj. , YTj , HTT , [T] ,p,q,r,p,q,r. The subroutine returns: ^ , 

\ » Y 3 » e 4 > ®b » e c ’ h ’ \ ’ % » °C * * n G f ° r outputting if 

y z 

desired. 
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RIGID BODY PARAMETERS 



All rigid body parameters (mass , I x , I , C.G. position) are linearly 
interpolated between the initial values at lift-off and the final values when 
the missile thrust motor is expended. The instantaneous position of the 
center of gravity x is defined relative to the reference point for the 
aerodynamic data as in Figure 12. The following table indicates the parameters 
as used in the program. 



PARAMETER 

m 



x 



eg 



LIFT OFF 
6.742 
65.1 
.420 
-.321 



BURN OUT 

4.710 slug 

48.1 slug-ft^ 

.245 slug-ft^ 

.4o6 ft 



ATMOSPHERE 



4 



s = .13635 ft 2 
d = .4167 ft 



X JRC 

T JRC 



= 2.434 ft 
= 400. lbs 
= 3000. lbs 



Both the density and acoustical velocity of air as functions of height are 
generated within ATMOS. A linear interpolation of these parameters is based 
on data from an ICAO Standard Atmosphere Table at heights of 0. and 1000. ft. 

Additionally values for the X and Y components of surface winds maybe 
entered as constant or functions of altitude depending on the operator's pre- 
ference. 
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TARGET 



Subroutine target calculates the time history trajectory of the target 
as a function of its initial inertial position, constant inertial velocity 
components and time. 

THRUST 

Missile thrust is assumed to be a constant THR for a duration of burn 
TBURN, after which THR = 0 . . 
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Figure 1. Definition of Missile Fixed Coordinate System 




End View Looking Forward 

Figure 2. Definition of Pitch Axes Coordinate System 



a 




a = COS 1 (u^yV) 

\j = cos" 1 (w T /(v T 2 +-w T 2 ) 2 ) 
If <> = 0,^=0 



Figure 3- Relative Wind Orientation 
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JRC Thruster Axis 




Projection of 
Relative Wind 



End View Looking Forward 



Figure 4. Relative Wind Orientation 

With Respect to the JRC Thruster Axis . 
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- 3^0 
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-2 - 




a in degrees 



Figure 7. K vs a for $ T = 0 , tt/2 , n • 

Z J 




Figure 8. 



K vs a for § T = 0 , tt/2 , tt . 
m o ' 
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X. 

1 


X i+1 x i+2 


X i+3 


X i+4 




X i+5 


1 . 


At 


X = X. 

1 


evaluate z! , y! 

11 


and predict ^ 


and 


rs-/ 

y i+5 


us ing h and 




h 

s 


respectively. 










2. 


At 


x = x. evaluate z! , 

l+l 1+1 ’ 


y! and correct 

l+l 


Z i+1 


and 


y i+5 us ing 




h 


and h 

s 


respectively. 










3. 


with y i+5 


now fixed, at x = 


X i+1 ’ X i+2 » **• 


evaluate only , 



z i+2 ’ ' * ' an< ^ se <l uentiall y predict 2 ^ + g > ^+3 » • • • an< ^ correct 

z i+2 ’ z i + 3 > • • ' until x ■ x i+5 • 

4. Repeat steps (l) - (3) for successive increments of h 

s 



Figure 9- Dual Speed Integration for One 
Large Step h 

s 
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Figure 10. Definition of JRC Orientation. 
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°A = tan- 1 (z mT/ x mT ) 

°b ’ tan_1 

Figure 11. Definition of Target Azimuth 
and Elevation Angles. 
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APPENDIX A 



PROGRAM LISTING 

The following is a FORTRAN listing of the simulation program designed for 
compatibility with the United Computing Service, Inc. time sharing system. 

A typical input/output listing is also included. 
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i-AGE 



1 



SXDF 



03/28/73. 15.35.59 



C01C0 PROGRAM SXDFCI NFUT* OUTFUT* TAPE 1 , TAPE2 * TAFE3 ) 

0G110 COMMON Y ( 9 ) > DY ( 9 ) >X ,H * W I NDXB* WI NDYB, WI NDZB* F.MACH 

00120+ 3 CFH IV>XFA>YFA>ZFA> THR*XCG > RMASS* FCAN > Y CAN*XM.» YM* ZM*XX I * YY1 



00130+ 

00140+ 

00150 

00160* 

00170 

00180* 

00190 

00200 * 

00210 

00220 * 

00230* 

00240 



>VSND> SPH I W*HTE> C'UE> ALPHA* PHI W *X MAX .» TBURN* RHO* VEL* P SI * THT* 
PH I * Z ( 14)* DZ (14) 

COMMON NDIM*IPRI NT * NSTEP * NPRI NT * I COUNT* I RATE* I RATI 0* NDI MF 
COMMUNICATIONS BETWEEN SUBROUTINE CTLSYS* AROJRC 
COMMON/CTLSYJ/ I JET ( 4 ) 

COMMUNICATIONS BETWEEN SUBROUTINES TRNSMT* TARGET* SEEKER 
COMMON/TRANS/T 1 1 * T 1 2 * T 1 3 3 T2 1 * T22 * T2 3 * T3 1 * T32*T33 
COMMUNICATIONS BETWEEN SUBROUT INES CTLSYS* SEEKER 
COMMON /SEEKR/ EFB* SFH I 1*CPHI 1 * EPBC 
EGUI VALENCING COMMON MISSILE TERMINOLOGY TO THE STATE VARIABLES 
Y(I) AND Z(I) AND THEIR RESPECTIVE DERIVATIVES DYCI) AND DZ(I) 

EQUIVALENCE (U*Y(1))*CV*Y(2))*(W*YC3))*CXI*YC4))*CYI*YC5))* 



00250+ 
00260+ 
00270+ 
002S0+ 
00290* 
00300* 
00310 
00320+ 
00330+ 
00340+ 
00350+ 
00 360 
00370 
00380 
00390 
00400 
00410 
00420 
00430 
00440 
00450 
00460 
00470 
00480 
00490 
00500 
00510 
00520 
00530* 
00540 
00550* 
00560* 
00570* 
00580* 
00590* 
00600* 
006 10* 
00620 
00630 
00640* 
00650* 
00660* 
00670 
00680* 



(HT*YC6))*(P*YC7))*CG*YC8))*CR*Y(9))* 

( UD* DY < 1 ) )*(VD*DY(2))*CWD*DYC3))* 

(XI D*DY(4) )* C YID*DYC 5) )* CHTD*DY(6) )* CPD*DYC7) )*(QD*DY(8) )* 
(RD*DYC9) ) 

EGUI VALENC I NG COMMON MISSILE TERMINOLOGY TO THE STATE VARIABLES 
Y(I) AND Z(I) AND THEIR RESPECTIVE DERIVATIVES DY(I) AND DZ(I). 
EQUIVALENCE < WYX * Z ( 3 ) ) * ( PH I 1, Z ( 4 ) ) * < WCZ *Z ( 5 ) ) * ( P SI 2 * Z < 6 ) ) * 
CWGY*Z(7 ) )* CWGZ*ZC8) ) * ( PSI 3, Z ( 9 ) ) * < THT4*Z ( 10) )* 

( E0*Z ( 1 1 ))*(E1*Z( 12) ) * ( E2 *Z ( 1 3) )* CE3*Z( 1 4) ) * ( PHI 1 D* DZ < 4) ) * 
( PSI 2D* DZ ( 6 ) ) * (E0D*DZC 1.1 ) )* (E1D*DZ( 1 2 ) ) * C E2D* DZ C 13) )* 

( E3D* DZ ( 14) ) 

DATA CON4/57 .29577951 /*GRAV/32 .2/ 

DATA CONI /I .0/ 

RETRI EVEC CTLSY S ) 

F.ETRI EVEdNIT) 

RETRI EVEC THRUST) 

RETRI EVE( AERO) 

RETRI EVEC TRNSMT) 

RETRI EVEC TARGET) 

RETRI EVEC RBPRMT) 

RETRIEVEC INTEG) 

RETRI EVEC AROBSE) 

RETRIEVEC SEEKER) 

RETRI EVEC ATMOS) 

RETRI EVEC A.ROJRC) 

RETRIEVEC INTER2) 

RETRIEVEC OUTFUT1 ) 

REWIND 2 

INITIALIZE ALL FROGRAM VARIABLES 
CALL INIT 

THE INTEGRATION ROUTINE REQUIRES TWO EVALUATIONS OF THE STATE 
VARIABLE DERIVATIVES FOR EACH TIME STEF. ADDI TI ONALLY* THE STATE 
VARIABLES ARE SEPARATED INTO TWO CATEGORIES) ZCI) FOR VARIABLES 
WHICH UPDATE AT EVERY TIME STEF H* AND YCI) FOR VARIABLES WHICH 
UPDATE ONLY EVERY "IRATIO" TIME STEFS. 

CALCULATE THE NUMBER OF DERIVATIVE EVALUTI ONS NECESSARY FOR 
"IRATIO" NUMBER OF TIME STEPS. 

IRT2 = 2*I RATI 0 
3 DO 2 K= 1 * I RT2 

THE START OF THE DERIVATIVE EVALUATION LOOF . 

CALCULATE THE TRANSFORMATION MATRIX BETWEEN THE INERTIAL AXIS 
SYSTEM AND THE MISSILE BODY FIXED AXIS SYSTEM. 

CALL TRNSMT 

CALCULATE THE DERIVATIVES OF THE QUATERI ON VARIABLES. 
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00690 

00700 

00710 

00720 

00730 

00740* 

00750* 

00760* 

00770* 

00780* 

00790 

0G800* 

00810 

00820* 

00830 

00840* 

008 50 
00860* 
00870 
008 80 
00890* 
00900* 
00910* 
00920* 

009 30 
00940* 
009 50 
00960* 
00970 
00980* 
00990 
01000 
01010 
01020 * 
01030 
01040 
01050 
01060 
01070 
01080* 
01090* 
01100 
01110 
01120 
01130 
01140 
01150 
01160 
01170 
01180 
01190 
01200 
01210 
01220 
01230 
01240* 
01250 
01260* 
01270 



EFS= 1 .+T1 1+T22+T33-4.*E0*E0 
E0D=-.5*(E1*P+E2*Q+E3*R>+EPS*E0 
E 1 D= . 5* ( E0*P + E2*R-E3*Q > + EF S*E1 
E2D= . 5* ( E0*Q+E3*F -E 1 *R > +EPS*E2 
E3D= . 5* C E0*R+E 1 *Q-E2*F > + EFS*E3 
IT IS NOT NECESSARY TO REEVALUATE ALL OF THE DERIVATIVES WHEN 
ONLY THE Z(I>, AND NOT THE Y( I > * VARIABLES ARE BEING UF DATED. 
"IRATE” EQUALS 1 IN THIS SI TUATI ON, OTHERWI SE IT EQUALS 0. 

WHEN "IRATE" EQUALS 1, PORTIONS OF THE LOOP ARE BYPASSED TO 
PREVENT RECOMFUTAT I ON OF NON-UFDATED VARIABLES. 

IF (IRATE. EG. 1) GO TO 20 
COMPUTE TARGET POSITION. 

CALL TARGET 

COMPUTE MISSILE THRUST. 

CALL THRUST 

COMPUTE THE INSTANTANEOUS VALUES OF THE RIGID BODY PARAMETERS. 
CALL RBPRMT 

COMPUTE THE PERTINENT ATMOSPHERIC PARAMETERS. 

CALL ATMOS 
20 CONTINUE 

SIMULATE THE SEEKER DYNAMICS. THE SEEKER VARIABLES MUST BE 
INTEGRATED WITH THE SMALL TIME STEP TO AVOID COMPUTATIONAL 
INSTABILITIES, AND HENCE ARE EVALUATED DURING EACH PASS THROUGH 
THE LOOP. 

CALL SEEKER 

BYPASS PORTIONS OF THE LOOP BASED ON "IRATE". 

IF ( I RATE. EG. 1) GO TO 30 
DETERMINE THE MISSILE CONTROL VARIABLES. 

CALL CTLSYS 

ADD THE EFFECTS OF ATMOSPHERIC WINDS. 

UT=U-WINDXB 
VT=V-WI NDYB 
WT=W-WI NDZB 

CALCULATE MISSILE VELOCITY, MACH NUMBER, AND DYNAMIC PRESSURE. 
VEL2=UT*UT+VT*VT+WT*WT 
VEL= SGRT( VEL2 ) 

VEL 1 = SORT ( VEL2-UT *UT> 

GUE= . 5*RH0*VEL2 
RMACH=VEL /VSND 

DETERMINE ALPHA AND PHI OF THE WIND. AT THE SINGULARITY OF 
ALPHA=0 , PHI IS DEFINED AS =0. 

PRMT=CONl 

IF (VEL.GT.0.) PRMT=UT/VEL 

IF (ABS(PRMT) .GE.l .0) PRMT=SI GN( CON 1 ,FRMT ) 

ALPHA=C0N4*AC0S( PRMT ) 

PHI W=0 . 

SFHIW=0. 

CPH I W= 1 • 

IF (VEL1.EQ.0.) GO TO 10 
SPHIW=VT/VEL1 
CFHIW=WT/VEL 1 

IF (ABS(SPHIW) .GE.l .0> SFHI V=SIGN(CONl , SPHIW) 

IF (ABSCCFHIW) .GE. 1 .0) CPH I W = SI GN( CON 1 , CPHI W ) 

PHI W=CON4*ACOS( CPHI W ) 

IF (SPHIW. LT.0.) PHIW=-FHIW 
DETERMINE THE AERODYNAMIC FORCES AND MOMENTS. 

10 CALL AERO 

SUM THE AERO, THRUST, AND GRAVITY FORCES. 

XF =XFA + THR + T 1 3*GRAV*RMASS 
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YF=YFA+T23*GRAV*RMASS 

ZF=ZFA+T33*GRAV*RMASS 

EVALUATE THE MISSILE STATE VARIABLE DERIVATIVES. 
UD=R* V-G *W+XF /RMASS 
VD=P*W-R*U+YF /RMASS 
WD=Q*U-P*V+ZF /RMASS 
R D=XM/XX I 
FRMT = F * ( XX I -YYI ) 

QD=< -R+FRMT+YM) /YYI 
RD= C Q+FRMT+ZM) /YYI 
XI D=U*T 1 1+V*T21+W*T31 
YID=U*T12+V*T22+V*T32 
HTD=-(U*T13+V*T23+W*T33> 



30 CONTINUE 

DETERMINE WHETHER OUTPUT IS DESIRED. ”IFRINT”=0 INDICATES 
THAT THE INTEGRATION ROUTINE HAS ONLY PREDICTED AND HAS NOT 
CORRECTED* THEREFORE THE OUTPUT IS MEANINGLESS. "IFPINT"=1 
INDICATES THAT OUTPUTING IS POSSIBLE. 



IF ( IPRINT.EC .0) GO TO 6 
DETERMINE IF THE DESIRED OUTPUT 
IF ( MOD( NSTEF > NPR I NT ) .GT.0 
CONVERT THE GUATER I ONS TO EULER 
SINGULARITY OF THETA=+-90, FSI 
IS CALCULATED. 

IF (ABS(T13) .GE.l .0) T13=S 
THT=C0N4*AS1N( -T13) 

IF (ABS(THT) .EG. 90.) GO TO 
FSI =C0N4*ATAN2( T12*T1 1 > 

PHI =C0N4*ATAN2( T23* T33) 

GO TO 5 



INTERVAL IS SATISFIED. 

GO TO 6 

ANGLES FOR OUTPUTING. AT THE 
S DEFINED AS =0 AND PHI 

GN ( CONI * T 1 3 ) 

A 



4 P SI =0 . 



PHI =C0N4*ATAN2( T21 *T31 > 

5 CONTINUE 

KEEP TRACK OF THE NUMBER OF TIMES OUTPUTING IS PERFORMED. 
I COUNT= I COUNT+ 1 

CONVERT RADIANS TO DEGREES FOR OUTPUTING. 

PSI20=PSI 2* C0N4 
THT40=THT4*C0N4 
PHI 1 0=PH I 1 *C0N4 
EFB0=EPB*C0N4 



PSI 30=P SI 3+C0N4 
EPBC0=EPBC*C0N4 
WRITE THE OUTPUT VARIABLES 

WRI TE( 2* ) X*U*V*W*XI * Y I *HT* P * 0 * R*PSI * THT* PHI * 

ALPHA * PHIU*PHI10*PSI20*PSI30*THT40* EPBO* EPBCO* 

WYX * VCZ *WGY * WGZ * PH I 1D*FSI2D* ( I JETC 1 > * I = 1 * 4 > 

DETERMINE WHETHER OR NOT ALL VARIABLES ARE TO BE UPDATED 
DURING THE NEXT PASS THROUGH THE LOOP. ALL VARIABLES ARE 
EVALUATED ON THE FIRST AND SECOND PASSES AND ONLY THE ZCI) 
VARIABLES ARE EVALUATED ON ALL SUBSEQUENT FASSES UNTIL AN 
M I RATIO” NUMBER OF STEFS HAVE BEEN TAKEN. 

6 I RATE=0 

IF (K.GT.2) I RATE= 1 
CALL THE INTEGRATION ROUTINE. 

2 CALL INTEG 

STOP THE PROGRAM WHEN THE REQUIRED TIME HAS ELAPSED. 

IF (X .LT.(XMAX+H*IRATIO) ) GO TO 3 
CALL THE PROGFiAM TO SORT AND SEQUENCE THE OUTPUT VARIABLES FOR 
FOR TTY COMPATIBILITY. 
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REWIND 2 

CALL OUTPUT 1 
END 
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10 SUBROUTINE INIT 

20 COMMON YC 9),DY( 9 > ,X,H,WINDXB,WINDYB,WINDZB,RMACH 

30+ ,CFHIW,XFA,YFA,ZFA,THR,XCG,F.MASS,PCAN,YCAN,XM,YM,ZM,XXI ,YYI 

40 + , VSND, SFHI V,HTE, GUE, ALPHA, PH I W,XMAX, TBURN, RHO, VEL,F SI , THT, 

50+ FHI , Z( 1 4) , DZ ( 14) 

60 COMMON NDIM,IPRINT,NSTEP,NPRINT,ICOUNT, IRATE, IRATIO,NDIMF 

70* COMMUNICATIONS WITH SUBROUTINE TARGET. 

80 COMMON/INI TL/XT0,YT0,HTT0,XTD,YTD,HTTD 

90 EQUIVALENCE ( E0, Z ( 1 1 ) ) , < El ,Z ( 1 2 ) ) , < E2,Z C 1 3 ) ) , < E3, Z ( 1 A ) ) 

100 100 FORMAT< *1 NPUT H,XMAX, NFRI NT, I RATI 0* ) 

110 110 FORMAT( *1 NPUT XT0, YT0,HTT0,XTD, YTD,HTTD* ) 

120* INITIALIZE INTEGRATION ROUTINE CONTROL VARIABLES. 

130 I RATE=0 

140 ICOUNT=0 

150 I PRI NT= 1 

160* SET DIMENSIONS OF Y(I) AND Z<I) RESPECTIVELY. IF DIMENSIONS 
170* ARE INCREASED ALSO INCREASE THE STORAGE LOCATION. DIMENSIONS 
180* SUBROUTINE INTEG. 

190 NDI M=9 

200 NDI MF =14 

210 PRINT 100 

220* READ FROM TTY THE STEP SIZE, RUN TIME, OUTPUT I NTERVAL, STEF SIZE 
230* RATIO. 

240 READ , H,XMAX,NPRI NT, I RATI 0 

250* READ FROM TTY THE TARGET POSITION AND VELOCITY. 

260 PRINT 110 

270 READ ,XT0, YT0,HTT0,XTD, YTD,HTTD 

280* TIME=0. 

290 NSTEF=0 

300 X=0. 

310* INITIALIZE ALL STATE VARIABLES TO 0. 

320 DO 1 1=1, NDI M 

330 Y < I ) =0 . 

340 1 DY ( I ) =0 . 

350 DO 2 1=1, NDI MF 

360 Z(I)=0. 

370 2 DZ( I ) =0 » 

380 HTE=6 • 

390 TBURN=4 . 5 

400* INITIAL EULER ANGLES FOR VERTICAL ORIENTATION. 

410 FSI =0 . 

420 THT=3. 141592653/2. 

430 PHI =0 . 

440* COMPUTE INITIAL QUATERI ON VALUES FROM EULER ANGLES. 

450 E0 = +COS< FSI /2 .) *COS( THT/2 .) *COS( PHI /2 .) +SI N( PSI /2 . )*SIN 

460+ (THT/2. )*SIN(PHI/2.) 

470 E 1=+C0S( FSI /2.)*C0S( THT/2. >*SIN( PHI /2.) -SI N( PSI /2. >*SIN 

480+ (THT/2. )*C0S(FHI/2.) 

490 E2=+C0S( FSI /2. )*SIN( THT/2 .) *COS(PHI /2 .) +SI N( PSI /2 . )*COS 

500+ (THT/2. )*SIN(PHI/2.) 

510 E3=-C0S( PSI /2. )*SIN( THT/2 . )*SIN(FHI /2 . )+SIN(PSI /2 . )*COS 

520+ (THT/2. )*C0S(FHI/2.) 

530 RETURN 

540 END 
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10 SUBROUTINE TRNSMT 

20 COMMON YC 9),DYC 9 ) ,X,H,WINDXB,WINDYB,UINDZB,RMACH 

30+ , CPHIW,XFA,YFA,ZFA,THR,XCG,RMASS,PCAN,YCAN,XM,YM,ZM,XXI,YYI 

40+ , VSND, SPHIVJ,HTE,GUE, ALPHA, PHI W,XMAX, TBURN,RHO,VEL,PSI , THT, 

50+ PH I , Z ( 14), DZ (14) 

60 COMMON NDIM,IPRINT,NSTEP,NPRINT,ICOUNT, IRATE, IRATIO,NDIMF 

70 COMMON/TRANS/T1 1 , T1 2, T1 3, T2 l ,T22, T23, T3 1 , T32, T33 

80 EQUIVALENCE < E0, Z < 1 1 ) ) , ( El , Z C 1 2 ) > , ( E2, Z< 1 3 > ) , < E3, Z< 1 4) ) 

90* CALCULATE THE ELEMENTS OF THE TRANSFORMATION MATRIX FROM THE 
100* QUATERNION VARIABLES. 

110 Til =E0*E0+E1*E1 -E2*E2-E3*E3 

120 T12=2.*(E1*E2+E0*E3) 

130 T13=2.*<E1*E3-E0*E2) 

140 T21=T12-4«*E0*E3 

150 T22=Tll-2.*(El*El-E2*E2) 

160 T23=2.*(E2*E3+E0*E1 ) 

170 T3 1 ®T 1 3+4 . *E0*E2 

180 T32=T23-4.*E0*E1 

190 T33=T1 1-2.*(E1*E1-E3*E3) 

200 RETURN 

2 1 0 END 
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10 SUBROUTINE TARGET 

20 COMMON Y ( 9 ) > DY ( 9 ) *X>H,WI NDXB..WI NDYB, WI NDZB> RMACH 

30+ » CPH IW^XFA^YFA^ZFA> THR..XCG » RMASS* FCANj YCANjXM.* YMj ZM jXXI ,YYI 

40+ » VSNDj SFHI W* HTE* QUE> ALPHA>FHI W>XMAX> TBURN>RHO.» VEL*PSI > THT> 

50+ FHI ..ZC 14) ,DZC 14) 

60 COMMON NDI M* I FRI NT> NSTEP>NPRI NT* I COUNT* I RATE* I RATI 0* NDIMF 

70 COMMON/TARG/XTI *YTI *HTTI 

8 0* COMMUNICATIONS WITH SUBROUTINE I NIT 

90 COMMON/INI TL/XT0* YT0*HTT0*XTD*YTD*HTTD 

100 COMMON /TRAN S/T 1 1 * T 1 2, T 1 3, T2 1 * T22* T23*T3 1 * T32* T33 

1 10 COMMON/SEEKR 1/SIGA*SIGB* SI GAD* SI GBD 

120 EQUIVALENCE < U* Y < 1 ) ) * C V* Y < 2 ) ) * < W.* Y< 3 ) ) * CXI *Y< 4) ) * < YI * YC 5 ) ) * 

1 30+ CHT*YC6) )* CF>YC7) ) * C Q * Y < 8 ) ) * ( R* Y C 9 ) ) 

140 DATA CONI /57 .29577951 / 

150* COMPUTE THE INERTIAL POSITION OF THE TARGET 
160 XTI =XT0+X*XTD 

170 YTI =YT0+X*YTD 

180 HTTI =HTT0+X*HTT D 

190* COMPUTE THE TARGET FOSITION RELATIVE TO THE MISSILE IN THE 
200* INERTIAL AXIS SYSTEM. 

210 XIMT=XTI -XI 

220 Y I MT=YTI -Y I 

230 HTM1-HTTI -HT 

240* TRANSFORM THIS INTO MISSILE BODY COORDINATES. 

250 XMT=T 1 1*XIMT+T12*YIMT-T13*HTMT 

260 YMT=T21*XIMT+T22*YIMT-T23*HTMT 

270 ZMT=T31*XIMT+T32*YIMT-T33*HTMT 

280* COMPUTE THE MOTION OF THE TARGET AS VIEWED FROM THE MISSILE 
290* AXES USING THE VELOCITIES OF THE TARGET AND THE MISSILE AND 
300* THE ROTATIONAL RATES OF THE MISSILE. 

310 XMTD=T1 1*XTD+T12*YTD-T13*HTTD-U-Q*ZMT+R*YMT 

320 YMTD=T2 1*XTD+T22*YTD-T2 3*HTTD-V-R*XMT+P*ZMT 

330 ZMTD=T3 1 *XTD+T32*YTD-T33*HTTD-W-P*YMT+Q*XMT 

340* COMPUTE THE AZIMUTH AND ELEVATION ANGLES OF THE TARGET AS 

350* SEEN BY THE MISSILE AND THEIR RESPECTIVE RATES. 

360 SI GA=ATAN2( ZMT*XMT ) *CONl 

370 SIGB=ATAN2C YMT*XMT) *CONl 

380 SIGAD=CONl*(XMT*ZMTD-XMTD*ZMT)/CXMT*XMT+ZMT*ZMT) 

390 SI GBD=CON 1 * < XMT*YMTD-XMTD*YMT ) / ( XMT*XMT+YMT*YMT ) 

400 RETURN 

410 END 
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SUBROUTINE THRUST 

COMMON Y< 9 ) .* DY ( 9 ) .» X..H, Wl NDXB., Wl NDYB, VJI NDZB,RMACH 
* CFH I W.»XFA> YFAjZFA.# THRjXCGj RMASS.» PCAN* YCAN*XM* YMjZM*XX I * YY I 
* VSND.» SPHIW,HTE, QUE, ALPHA, PHI W/XMAX, TBURN^RHO* VEL/FSI , THT, 
PHI tZ(. 14),DZ< 14) 

COMMON NDI M.» I FRI NT* NSTEP* NFRI NT * I COUNT > I RATE* I RATI 0> NDI MF 
THR= 3000 • 

IF (X.GT.TBURN) THR=0 . 

RETURN 

END 
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10 SUBROUTINE RBPRMT 

20 COMMON YC 9),DY< 9 ) ,X,H, VI NDXB,WINDYB, WINDZB,RMACH 

30+ ,CFHIW,XFA,YFA,ZFA,THR,XCG,RMASS,FCAN,YCAN,XM,YM,ZM,XXI,YYI 

40+ ,VSND, SFH IW,HTE,QUE, ALPHA, PH I W * XMAX , TBURN , RH 0 , VEL , F S I , THT, 

50+ PHI,Z< 14>,DZC 14) 

60 COMMON NDI Mil FRI NT, NSTEF , NFRI NT, I COUNT# I RATE.. I RATI 0* NDI MF 

70 DATA RMASS0/6 .742/, YY 10/65.1 /,XXI 0/ »420/,XCG0/- .321/, 

8 0+ RMASSD/- » 4506/, YY I D/-3 »778/,XXI D/- .03889/, XCGD/ .16152/ 

90 IF (X.GT. TBURN) GO TO 1 

100* IF THE MAIN ROCKET IS STILL ON, THE MISSILE'S MASS, MOMENTS 
110* OF INERTIA AND CG POSITION ARE CALCULATED BASED ON THE INITIAL 
120* VALUE PLUS AN AVERAGE RATE OF CHANGE TIMES THE ELAPSED TIME. 

130 RMASS=RMASS0+X* RMASSD 

140 XXI =XXI 0+X*XXI D 

150 YYI =YYI 0+X*YYI D 

160 XCG=XCG0+X*XCGD 

170 1 RETURN 

180 END 
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SUBROUTINE ATMOS 

COMMON Y ( 9 ) jDY< 9 ) ,X,H, WI NDXB, WINDYB, WI NDZB, RMACH 

,cphiw,xfa,yfa,zfa,thr,xcg,rmass,pcan,ycan,xm,ym,zm,xxi,yyi 
, VSND, sphi w>hte, que, alpha, phiw,xmax,tburn,rho,vel,fsi,tht 
PH I , Z ( 14),DZC 14) 

COMMON ndim,iprint,nstep,nfrint,icount,irate,iratio,ndimf 
COMMON/TRANS/T1 1 , T1 2, T1 3, T2 1 , T22, T23, T3 1 , T32, T33 
EQUIVALENCE <HT,Y<6>) 

RHO=. 0023769 -HT*. 0000000688 
VSND=1 1 16.89-HT*. 00384 
SET THE INERTIAL COMPONENTS OF THE WIND. 

WI NDXI =0 • 

WINDY 1=0. 

TRANSFORM INTO MISSILE AXES. 

WI NDXB=WI NDXI *T 1 1 +WINDYI *T 1 2 
W I NDYB=W I NDX I * T2 1 +WI NDY I * T2 2 
WI NDZB=WI NDXI *T3 1 +WI NDYI *T32 
RETURN 
END 
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SUBROUTINE SEEKER 

COMMON YC 9 ) * DY < 9 ) ,XjH, WI NDXB* WI NDYB* WI NDZB* RMACH 
*CFHIW*XFA*YFA*ZFA*THR*XCG*RMASS*PCAN*YCAN*XM*YM*ZM*XXI *yyi 
* VSND* SFHI W*HTE* QUE* ALPHA* PHI W*XMAX* TBURN*RHO* VEL*PSI * THT* 

FH I * Z ( 14)* DZ ( 14) 

COMMON NDIM* I PRI NT* NSTEP* NPRI NT* I COUNT* I RATE* I RATI 0* NDIMF 
COMMON/TRANS/T 1 1 * T 1 2 * T 1 3* T2 1 * T22* T23* T3 1 * T32* T33 
COMMON/TARG/XTI * YTI *HTTI 
COMMON/SEEKR/EFB* SPHI 1*CFHI 1*EPBC 
EQUIVALENCE (EL*ZC 1 ) ) * ( ER*Z( 2 ) ) * ( WYX*Z ( 3) ) * ( PHI 1*Z( 4) )* 
(WCZ*Z( 5) ) * CPSI2*Z(6) )* (WGY*Z(7) )* (WGZ*ZC8) )* (FSI3*Z(9) )* 

( THT4*Z ( 1 0) ) * C ELD* DZ ( 1 ) ) * ( ERD* DZC 2 ) ) * C WYXD* DZ< 3 ) ) * < PHI 1 D* DZ 
(4) )* <WCZD*DZ<5) )*<PSI2D*DZC6) ) * C WGYD* DZ C 7 ) ) * C WGZD* DZ(8 ) )* 
(PSI 3D* DZ ( 9 ) ) * ( THT4D* DZ C 10))*CF*YC7))*CQ*Y(8))*(R*YC9))* 

( FD* DY C 7 ) ) * < QD* DYC 8 ) ) * C RD* DYC 9 ) ) 

EQUIVALENCE CXI*Y(4))*(YI*YC5))*CHT*Y(6)) 

DATA INIT/0/*TlFSI/. 0125/* T2PSI/. 0033/* 

RKFSI /-960./*EFSI DB/2 5 . /* RKBFSI / .046/* RN2/- 1 . /*RFSI / 1 0 . 5/* 

RI PSI B/2 . 3/*RKTFSI /6 . 54/* T2FHI / .005/* T1FHI / .025/* RKFHI /300./ 
* EFHI DB/25 . /* RKBFHI / . 199 /*RPHI /8 .8 /*RKTPHI /28 • 1 /*RI PHI B/2 .84 
/*RKTT /350 . /* RKPTE/ .2/* TGYEB/4 . /* TGZEB/4 ./*F1*F2*F3*F4/10.*2 
.* .5* . 5/* FSI 2L*PSI 3L* THT4L/2 .35* . 2 1 * .2 1 /* CKSTF2* CKSTF3* CKSTF 
4/800.* 400 • * 400 . /* RI YX* RI YY *RIYZ/.25* .20* . 1 0/*HS* RI GZ * RI GY* R 
KHG/3.5* .009* .009* .005/*RI CX*RI CY*RI CZ/.04* .08* .08/*RIDPSI 
/ .0007 /* RKCU2/ .8 /* TYX2* TYY2* TYZ2/3+0 ./*TCZ3* TCY3* TCX3/3*0 . /* 
TCXE* TCYE* TCZE/3 + 0 . /* TYXU* TYYU* TYZU* TCXU* TCYU* TCZU* TRXU* 
TRYU* TFlZU* THXU* THYU* THZU* TGYU* TGZU* TGY5* TGZ5/ 1 6*0 . / 

DATA CONI/3. 141 592654/* C0N2/6.28 31 8 5308/ 

XMTI =XTI -XI 
YMTI =YTI -Y I 
ZMTI =-<HTTI -HT) 

RMT=SQRTCXMTI *XMTI +YMTI *YMTI +ZMTI *ZMTI ) 

RNXI =XMTI /RMT 
RNY I =YMTI /RMT 
RNZ I =ZMTI /RMT 

RNMX=T 1 1*RNXI +T12+RNYI +T1 3*RNZI 
RNMY=T2 1 *RNXI +T22+RNYI +T23*RNZ I 
RNMZ=T31*RNXI +T32+RNYI +T33*RNZI 
IF (INIT.EQ.l) GO TO 1 
I NI T= 1 
I SVJSZ = 0 

SFSI 2 = SQRTC RNMY + RNMY +RNMZ*RNMZ ) 

PSI 2=ATAN2( SPSI 2*RNMX ) 

PHI 1=0. 

IF CSPSI2.NE.0.) PHI 1=ATAN2(RNMZ*RNMY) 

1 CONTINUE 

SPHI 1=SIN(PHI 1 ) 

CPHI 1 =COS( PHI 1 ) 

SFSI2=SIN(PSI2) 

CPSI2=C0SCPSI2) 

SFSI3=SINCPSI 3) 

CP SI 3=C0SCFSI3) 

STHT4 = SIN< THT4) 

CTHT4=C0S( THT4) 

SPSIT=SPSI2*CPSI 3+CPSI2*SPSI3 
CPSIT=CFSI2*CFSI 3-SPSI 2* SPSI 3 

EPBPSI = -RNMX* SPSI T+RNMY *CPHI 1 *CPSI T+RNMZ*SPHI 1 *CPSI T 
EFBTHT=-C RNMX*CPSI T*STHT4+RNMY*C CPHI 1 *STHT4*SPSI T-SPHI 1+CTHT 
4)+RNMZ*C CPHI 1*CTHT4 + SPHI 1 *SPSI T+STHT4 ) ) 
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10 



20 

30 



40 

50 

ROLL 



RNCY=-RNMX*SPSI2+RNMY*CPSI2*CPHI 1+RNMZ*CPSI 2*SFHI 1 
RNCZ=-RNMY*SPHI 1+RNMZ*CPHI1 
EFBC=SQRT< RNCY*RNCY+RNCZ*RNCZ ) 

EPB=SQRT< EPBPSI *EPBPSI + EPBTHT*EPBTHT> 

RLAMCG=SQRT( THT4+THT4+PSI 3*PSI 3) 

CALCULATION OF GAIN COMPENSATION IN ROLL AXIS DRIVE 
IF CABSCPSI2) .LT. .579) GO TO 10 
VCCOMP=SIGN< 1 .0,PSI2) 

GO TO 30 

IF (ABSCPSI2) .LT. .174) GO TO 20 
VCCOMP=SIGNC 3.3,PSI2) 

GO TO 3B 

VCCOMP=SIGN< 1 0 • 5*FSI 2 ) 

CONTINUE 
THRESH = .10 

IF (ISUSZ.EQ.l) THRESH= .05 
IF (RLAMCG.GT. THRESH) GO TO 40 
IF CABS(PSI2) .GE. THRESH ) GO TO 40 
EPSR=0. 

I SWSZ=0 
GO TO 50 

EPSR= -THT4*VCC0MF 
ISWSZ=1 
CONTINUE 

AXIS DRIVE TORQUE MOTOR 
ERD=< EFSR-ER) /T2PHI 
EPHI D=( T1FHI *ERD+ER) *RKPHI 
EFH I DL=BOUND( EPH I DB.» EFHI D ) 

EPHNET=EPHIDL-PHI 1D*RKBFHI 
RIPHI =EPHNET/RPHI 

TYXMOT=RKTPHI *BOUND(RIPHIB>RIPHI ) 

OUTER LOOK AXIS DRIVE TORQUE MOTOR 
EPSL=PSI 3 

ELD=< EPSL-EL) /T2PSI 
EFSID=(T1PSI *ELD+EL)*RKPSI 
EPSI DL=BOUND< EPSI DB, EPSI D) 

EPSNET=EPSI DL-RKBPSI *RN2*PSI 2D 
RIPSI =EPSNET/RPSI 

TCZMOT=RKTPSI *BOUND( RIPSIB^RIPSI ) 

GYRO TORQUE CONTROL EQUATIONS 

TGYENL=RKTT* EPBPSI -RKPTE*PSI 3 

TGZENL=-RKTT*EPBTHT+RKPTE*THT4 

TGYE=BOUND(TGYEB,TGYENL) 

TGZE=BOUNDC TGZEB* TGZENL) 

SEEKER YORE DYNAMICS 

WYY=Q*CPHI 1+R*SPHI 1 
WYZ=-Q*SPHI 1+R*CFHI 1 

WYYD=QD*CPHI 1+F.D*SFHI 1-PHI 1D*(Q*SPHI 1-R*CPHI 1) 
OTZD=-QD*SPHI 1+RD*CPHI 1-PHI 1D*(Q*CPHI 1+R*SFHI 1 ) 
TYXF1=FRICTCFWPHI ID) 

TYX 1 =TYXMOT+TYXF 1 

TYX = TYX 2 + TYX U+ TYX 1 

TY Y= R I Y Y *WY Y D+W YZ *WYX *(RIYX-RIYZ) 

TYZ = RI YZ*WYZ D+WYX+WYY* ( RI YY -RI YX ) 

TYY 1=TYY-TYY2-TYYU 
TYZ 1 =TYZ -TYZ2-TYZU 
TMX 1 = - TYX 1 

TMY 1 = - < TYY 1 * CPH I 1-TYZ1*SPHI 1 ) 

TMZ 1 = - ( TYY 1 * SPH I 1+TYZ1*CFHI 1 ) 
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RICC=RICX*CFHI 1 *CPHI 1 +RI CY*SFHI 1 *SFHI 1 
RI YXE=RI YX+RI CC 

WYXD=(TYX-WYY*VYZ*(RIYZ-RIYY> J/RIYXE 
PHI 1 D=WYX-P 

SEEKER COIL HOUSING DYNAMICS 
WCX=WYX*CPSI 2+VYY+SPSI 2 
WCY=-WYX*SFSI 2+WYY+CFSI 2 
TCZF2=FRICT(F2*PSI2D) 

TCZS2=ST0PS(CKSTP2,PSI2L,FSI2) 

TCZ2=( TCZMOT-C RN2- 1 . > *RI DFSI *WYZD> +RN2+TCZF2+TCZS2-RKCU2* 
PSI 2 

TCZ=TCZ2+TCZU+TCZ3+TCZE 

WCZD= ( TCZ -WCX*VJCY * ( R I CY-RI CX ) ) /( RI CZ+RN2*RN2*RI DFSI ) 

PSI 2D=WCZ -WYZ 

TCXLI =RI CX* ( WYYD+SFSI 2-FSI 2D*( UYX+SPSI 2-WYY*CPSI 2 ) ) +WCY*WCZ 
* ( RI CZ-RI CY ) 

TCYLI=RICY*(WYYD*CFSI2-FSI2D*CWYX*CPSI2+VYY*SPSI2) )+VCZ*WCX 
* ( RI CX-RI CZ ) 

TCX2=TCXLI -TCX3-TCXE-TCXU 
TCY2=TCYLI -TCY3-TCYE-TCYU 
TYX2 = - C TCX2*CPSI 2-TCY2*SPSI 2 ) 

TYY2=-( TCX2*SPSI 2+TCY2*CPSI 2 ) 

TYZ2=-TCZ2 
GYRO DYNAMICS 

TGY=TGY5+TGYE+TGYU 

TGZ=TGZ5+TGZE+TGZU 

TGYEFF=TGY -HS*VJGZ- ( RKHG/RI GZ ) * ( TGZ+HS*WGY) 
TGZEFF=TGZ+HS*UGY+( RKHG/RI GY) *( TGY-HS*WGZ ) 

WGYD=TGYEFF/( RI GY+RKHG+RKHG/RIGZ ) 

WGZD=TGZEFF/( RI GZ+RKHG+RKHG/RI GY ) 

GYRO HOUSING DYNAMICS 
WHY=WGY 
WHZ=WGZ 

WRX=WCX*CPSI 3+WCY*SPSI 3 
WRY=-WCX*SPSI 3+WCY+CPSI 3 
WRZ=(WHZ-URX*STHT4) /CTHT4 
PSI 3D=WRZ-WCZ 
THT4D=WHY-WRY 
TRZF3=FRI CT(F3*PSI 3D) 

TRZS3=STOPS( CKSTP3..PSI 3L^PSI3) 

TRZ3=TRZS3+TRZF3 
TRZ4=-< TRZ3+TRZU) 

THYF 4=FRI CTC F4> THT4D) 

THYS4=ST0PS< CKSTP4., THT4L.* THT4) 

THX4=-THXU 

THY4=THYF4+THYS4 

THZ4=-( TRZ4+THX4*STHT4)/CTHT4 

THY5=- ( THYU+THY4) 

THZ5=- ( THZ4+THZU) 

TGY5=-THY5 

TGZ5=-THZ5 

TEX4=-( THX4+CTHT4+THZ4+STHT4) 

TRY 4= -THY 4 
TRX3=-( TRX4+TRXU) 

TRY3=-( TRY4+TRYU) 

TCZ3=-TRZ3 

TCX3 = -CTRX3*CPSI 3-TRY 3 + SPSI 3 ) 

■ TCY3=- ( TRX3*SPSI 3 + TRY 3*CPSI3) 

TCYE=-TGYE 
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TCZE=-TGZE 

RETURN 

END 
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FUNCTION ROUTINE FOR A 


LIMITER. 


1820 


FUNCTION BOUNDCXL, 


X) 


1830 


BOUND=X 




1840 


IF C ABS(X> .GE.XL) 


BOUND=SI GN(XL.»X ) 


1850 


RETURN 




1860 


END 
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FUNCTION ROUTINE FOR FRICTION. 
FUNCTION FRI CTC FL,X ) 

IF CX) 1,2,3 

1 FRI CT=FL 
RETURN 

2 FRI CT=0 . 

RETURN 

3 FRI CT=-FL 
RETURN 
END 
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2030 



FUNCTION ROUTINE FOR STOPS WITH COMPLIANCE. 
FUNCTION STOPSC SLOPEjXTjX) 

STOPS=E . 

DEL=ABS(X> -XT 

IF (DEL.GE.0.) STOPS =SLOFE* SI GN( DELjX ) 

RETURN 

END 
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10 SUBROUTINE CTLSYS 

20 COMMON Y ( 9 ) , DY ( 9 ) ,X ,H , W I NDXB , Wl NDYB , W I NDZB , RMACH 

30+ ,CFHIW,XFA,YFA,ZFA,THR,XCG,RMASS,PCAN,YCAN,XM,YM,ZM,XXI,YYI 

40+ ,VSND, SPHIW,HTE,GUE,ALFHA,PHIW,XMAX,TBURN,RHO,VEL,FSI,THT, 

50+ FHI,Z< 14),DZ< 14) 

60 COMMON NDI M, I PRINT, NSTEF , NPRI NT, I COUNT, I RATE, I RATI 0, NDI MF 

70 COMMON/CTLSYJ/ IJET<4) 

80 COMMON/SEEKR/EPB, SFHI 1 , CPHI 1,EFBC 

90* COMMUNICATIONS WITH SUBROUTINE TARGET 

100 C0MM0N/SEEKR1/SIGA, SI GB, SI GAD, SI GBD 

110 EGUI VALENCE <HT, Y ( 6 ) ) , ( PSI 2,Z ( 6 ) ) , ( PSI 2D, DZ ( 6 ) ) 

115 EQUIVALENCE (PHI 1 D, DZ C 4) ) 

120 DATA TBJRC/1 .2/ 

130 DATA CONI/. 18/ 

140* ENABLE THE CONTROL SYSTEM AT THE ENABLE HEIGHT. 

150 IF (HT-HTE) 1,2,2 

160 1 I JRC=0 

170 TSJRC=X 

180 GO TO 3 

190 2 I JRC= 1 

200* DETERMINE WHETHER THE JRC BURN TIME HAS BEEN EXCEDED, AND IF 
210* SO, DISENABLE THE JRC'S. 

220 IF ( (X-TSJRC) .GT.TBJRC) IJRC=0 

230 3 IF (IJRC) 4,4,5 

240 4 I JETC 1 ) =0 

250 I JETC 2) =0 

260 I JETC 3) =0 

270 I JET( 4) =0 

280 GO TO 6 

290* DETERMINE THE JRC STATES BASED ON THE CONTROL LAW. 

300* FRMTY CONTROLS THE JETS ON THE Y AXIS WHILE PRMTZ CONTROLS 

310* THE JETS ON THE Z AXIS. "I JETC 1 ) "= 1 SIGNIFIES THAT JET 1 IS ON. 

320 5 PRMTY=SI GB+C0N1 *SIGBD 

330 FRMTZ=SI GA+C0N1 * SI GAD 

340 IF CFFtMTZ) 7,8,9 

350 7 I JETC 1 ) = 1 

360 I JETC 3) =0 

370 GO TO 10 

380 8 I JETC 1 ) =0 

390 I JETC 3) =0 

400 GO TO 10 

410 9 I JET ( 1 ) =0 

420 I JETC 3) = 1 

430 10 IF (FRMTY) 11,12,13 

440 11 I JET< 2) = 1 

450 I JET< 4) =0 

460 GO TO 6 

470 12 I JET< 2) =0 

480 I JETC 4 ) =0 

490 GO TO 6 

500 13 I JET( 2) =0 

510 I JET( 4) = 1 

520 6 CONTINUE 

530* THE CANARD DEFLECTIONS ARE SET TO ZERO 
540 FCAN=0. 

550 YCAN=0. 

560 RETURN 

570 END 
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10 SUBROUTINE AERO 

20 COMMON YC 9),DY( 9 ) ,X>H,WI NDXB..WI NDYB, WI NDZB,RMACH 

30+ , CPHIW>XFA,YFA,ZFA,THR,XCG,RMASS,PCAN,YCAN,XM,YM,ZM,XXI,YYI 

40+ ,VSND,SPHIW,HTE,QUE> ALPHA, PHIW^XMAX, TBURN,RHO, VEL,FSI , THT, 

50+ PHI.,Z( 14),DZ( 14) 

60 COMMON NDIM,IPRINT>NSTEP>NPRINT>ICOUNT>IRATE>lRATIO,NDIMF 

70* COMMUNICATION WITH AROBSE 

80 COMMON/AROB/XFBjYFB#ZFB*XMB#YMB#ZMB 

90* COMMUNICATION WITH AROJRC 

100 COMMON/ARO J/YFJj ZF YM J>ZMJ 

110* DETERMINE BASELINE AERODYNAMIC FORCES AND MOMENTS. 

120 CALL AROBSE 

130* DETERMINE FORCES AND MOMENTS DUE TO THE JRC. 

140 CALL AROJRC 

150* SUM THE FORCES. 

160 XFA=XFB 

170 YFA=YFB+YFJ . 

180 ZFA=ZFB+ZFJ 

190* SUM THE MOMENTS AND TRANSFER REFERENCE POINT TO THE 
200* MISSILE CG. 

210 XM=XMB 

220 YM=YMB+YM J+ZFA+XCG 

230 ZM=ZMB+ZMJ-YFA*XCG 

240 RETURN 

250 END 



45 



PAGE 

10 

20 

30 + 

40 + 

50 + 

60 

70 

80 

90 

100 + 

1 10 

120 

130 

1 40 + 

1 50 + 

1 60 + 

170 + 

186 + 

190 + 

200 + 

2 10 + 

220 + 

2 30 

240 

250 + 

260 + 

270 + 

280 + 

290 + 

300 + 

310 + 

320 + 

330 + 

340 

350 

360 

370 

380 

390 

400 

410 

420 

4 30 

44e 

450 

460 + 

470 

480 + 

49 0 

500 + 

510 

520 + 

530 

540 + 

550 

560 + 

570 

580 

59 0 



AROBSE 03/28/73. 16.03.23 



SUBROUTINE AROBSE 

COMMON Y < 9 ) , DY < 9 ) ,X,H, W I NDXB, WI NDYB, WI NDZB ,RMACH 
,CPHIW,XFA,YFA,ZFA,THR,XCG,RMASS,FCAN,YCAN,XM,YM,ZM,XXI,YYI 
, VSND, SPHI V,HTE, CUE, ALPHA, PHI W,XMAX, TBURN, RHO, VEL, PSI , THT, 
PHI , Z ( 14),DZ< 14) 

COMMON NDIM, I PRI NT, NSTEP , NPP.I NT, I COUNT, I RATE, IRATI 0,NDIMF 

COMMON/AEROl /DFHI , DALFHA 

COMMON /AROB/XFB,YFB,ZFB,XMB,YMB,ZMB 

DIMENSION CXB(25,3) ,CYPB( 25, 3),CZPB<25,3), CLB( 25,3), 

CMFB( 25,3), CNPB< 25, 3) 

DATA CXB /75*0 . / 

DATA CYPB/7 5*0 • / 

DATA CZP'B/ 

0.,-2», -4.0, -6*5, -10.0, -13.0, -17.0, -21.0, -25.0, -2 9.5, 
-34.0,-38.0,-42.0,-45.0,-48.0,-51 .0, -52 .5, -52 .5, -5 1 .0, 

— 46*0,— 45*0,— 45*0,— 45.0,— 45*0,— 45*0, 

0., -2., -4. 5, -8. 0,-1 2. 0,-1 6. 0,-20. 5, -25. 0,-29. 5, -34. 5, 

-39. 0,-43. 0,-47 . 0,-50. 0,-52. 5, -52. 5, -48.0, -45.0,-49.0, 
-51.0,-52.0,-53.5,-54.5,-55.5,-55.5, 

0.,— 2.,— 4.0,— 6*5, — 10.0, — 13*0,— 17 .0,-21 .0,— 25.0,— 29 .5, 
-34.0,-38 .0, -42.0, -45. 0,-48. 0,-51 . 0, -52 . 5, -52 . 5, -5 1 .0, 

— 46*0,— 45*0,— 45*0,— 45*0,— 45*0,— 45*0/ 

DATA CLB /75*0./ 

DATA CMPB/ 

0.,— 8.,— 16.,— 26.,— 40.,— 60.,— 80.,— 100.,— 124., — 142., 

— 164*, — 186*,— 210.,— 230.,— 256*,— 278*,— 290.,— 290.,— 266», 
-206. ,-178. ,-166. ,-160. ,-158. ,-158., 

0.,— 8»,-20.,-36.,-56»,-76.,-l 00 .,-128. ,-158. ,-184., 

— 214.,— 238.,— 264.,— 282.,— 300.,— 286*,— 250.,— 200.,— 214., 

-2 18., -2 18., -2 18., -2 18., -220., -220., 

0.,— 8., — 16*,— 26*,— 40.,— 60.,— 80., — 100., — 124., — 142., 

-164., -186., -2 10., -2 30., -256., -278., -290., -290., -266., 
-206., -178., -166., -160., -158 .,-158./ 

DATA CNPB/7 5*0 • / 

DATA CON 1 /45 • /, CON2 /2 . 5/, CON 3/90 . / 

DATA DI A/. 41 66666667 /,S/. 1363538470/ 

FHI WT=AMOD( ABSC PHI W ) , C0N3 ) 

PHI WTE=FHI WT/CON1 + 1 .0 
IP=PHIWTE 
DPHI =PHIWTE- I P 
ALFHAE=ALPHA/C0N2+ 1 .0 
I A=ALPHAE 

IF (IA.GE.25) I A=24 
DALPH A=ALPHAE- I A 

CALL I NTER2( CXB <IA,IF),CXB ( I A+ I , I F ) , CXB CIA,IF+1), 

CXB ( I A+ 1 , I F+ 1 ) , CX ) 

CALL I NTER2 ( CYPB< I A , I F ) , CYFB< I A+ 1 , I F ) , CYPBC I A , I P + 1 ) , 

CYFB( IA+1, IP+1 ),CYP) 

CALL I NTER2(CZPB< I A, IF ) ,CZPB< I A+ l , IP) , CZFB( I A, I P+ 1 ) , 

CZPB< IA+1, IP+1), CZP) 

CALL I NTER2 ( CLB <IA,IP),CLB < I A+ l , I P ) , CLB (IA,IP+1), 

CLB (IA+1, IP+1), CL ) 

CALL INTER2(CMPB( I A, IP ) ,CMFB< IA+1, IF), CMPB( I A, I P+ 1 ) , 

CMPB( IA+1, IF+1), CMP) 

CALL I NTER2 ( CNPB (I A, IP), CNFB ( IA+1, IP), CNFB ( IA,IP+1), 

CNPB< IA+1, IP+1), CNF) 

CY = CYP * CPH I W + CZ P * SPH I W 
CZ=-CYP*SFHIW+CZP*CPHIU 
CM = CMP*CFHI W + CNF *SPHI W 
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CN=-CMP*SFHIW+CNF*CFHI W 

XFB=QUE*S*CX 

YFB=QUE*S*CY 

ZFB=QUE*S*CZ 

XMB=QUE*S*DIA*CL 

YMB=GUE*S*DIA*CM 

ZMB=CUE*S*DIA*CN 

RETURN 

END 



\ 
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SUBROUTINE AROJRC 

COMMON Y ( 9)*DY( 9 ) #X *K* WI NDXB* Wl NDYB* WI NDZB* RMACH 
* CFHI W *XFA*YFA*ZFA* THR*XCG* RMASS* FCAN* Y CAN*XM* YM* ZM* XX I *YYI 
* VSND* SFHI W*HTE*GUE* ALFHA*PHI WjXMAX* TBURNjRHO* VEL*F SI <THTi 
FHI *Z( 14) *DZC 14) 

COMMON NDIM*I PRINT* NS TEF*NPF.INT*I COUNT * I RATE* I RATI 0* NDI MF 
COMMON/AERO 1 /DPH1 * DALPHA 
COMMON/CTLSY J/ IJET(4) 

COMMON/AFO J/YF J* ZF J*YMJ*ZM J 
DIMENSI ON RKYB( 25*3 ) * RKZB( 25*3) *RKMB( 25* 3 ) * RKNBC 25 * 3) 
DIMENSION CFE( 4 ) * SFE( 4 ) 

DATA RKYB/7 5*0 . / 

DATA RKZB / 

-1.0*-1.0*-l.0*-l.0*-1.0*-.99*-.97*-.92* 

-•88*-.86*-.81*-.76*-.70*-»62*-.58*-.53* 

— . 52 j — . 53 j — . 58 j — «66j — «72j — *78j— .80* — .82* — .82* 

50* - 1 . 0/ 

DATA RKMB / 

1 .0*1 .0*1 .0*1 «C*1 .0*1 .03*1 .06* 1 .10* 
1.16*1.22*1.29*1.38*1.47*1.54*1.60*1.63* 
1.65*1.60*1.48*1.30*1.18*1.08*1 .04* 1.04*1.04* 

50* 1 .0/ 

DATA F.KNB/7 5*0 . / 

DATA TJRC/450 ./*X JET/2 .434/ 

DATA CONI /96 • /* C0N2/2 .5/* CON3/180 . / 

DATA FHI E 1/0./ 

DATA CPE/1 . *0.*-l .*0 ./*SFE/0. * 1 .*0.* -1 ./ 

ALPHAE=ALPHA/C0N2+ 1 .0 
I A=ALFHAE 

IF (IA.GE.25) I A=24 
DALFH A= ALFHAE- I A 
RKY=0 . 

RKZ=0 . 

RKM=0 . 

HKN=0 . 

DO t 1=1*4 

IF ( I JET (I).EQ.0) GO TO 1 
FKI J=PHI U-FHI El -CONI * C I — 1 . ) 

CP=CPE( I ) 

SF=SFE( I ) 

IF (ABSCFHI J) .GT. 180.) FHI J=FHI J-SI GN( 360 . *FHI J) 

PHI JT=ABS(PHI J) 

PHI JTE=PHI JT/CON 1 + 1 .0 
I F=FHI JTE 
IF (IF.GE.3) I P=2 
DFHI =FHI JTE-I F 

CALL INTER2(RKYE( I A* IF ) * RKYBU A+ 1 * I P ) * RKYB ( I A* I F+ 1 ) * 

F.KYBt IA+1 *IF + 1 )*RKYJ) 

CALL I NTER2 ( RKZB( I A* I P ) * RKZB( I A+ 1 * I F ) * RKZB( I A* I F+ 1 ) * 

RKZBC I A+l * IP+1 ) *RKZ J) 

CALL I NTER2 < RKMB ( I A * I F ) * RKMB ( I A + 1 * I F ) * RKMB ( I A* I F + 1 ) * 

RKMB( IA+ 1 * IF+1 ) jRKMJ) 

CALL INTER2(RKNB< I A* IF) *RKNB( I A+ 1 * I P ) * RKNB < I A* I F + 1 )* 

RKNB ( I A+ 1 * I F + 1 ) * RKN J) 

IF (FHIJ.GE.0.) GO TO 2 

KKY J=-RKYJ 

RKNJ=-RKNJ 

2 RKY=RKY+RKY J*CP +RKZJ*SP 
RKZ = RKZ-RKY J*SP +RKZJ*CF 
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59 0 


RKM=RKM+RKMJ*CP 


+RKNJ*SP 


600 


RKN=RKN-RKMJ*SP 


+RKNJ+CP 


610 


1 CONTINUE 




620 


YFJ=RKY *TJRC 




630 


ZFJ=RKZ*TJRC 




640 


YMJ=RKM*TJRC*X JET 


650 


ZM J=RKN*TJRC*X JET 


660 


RETURN 




670 


END 
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00 1 00 
001 10 
00120 + 

G0130+ 

00140+ 

00150 

00160 

00170 

00180 

00190 

00200 

00210 + 

00220 

00230+ 
00240 
00250+ 
00260 
00270 
00280 
00290+ 
00300 
00310 
00320* 
00330 
00340* 
00350* 
00360 
00370 
00380 
00390 
00400 
00410 
00420 
00430 
00440 
00450 
00460 
00470 
00480 
00490 • 
00500 
00510 
00520 
00530 



SUBROUTINE OUTPUT 1 

COMMON Y ( 9),DYC 9 ) ,X,H,WINDXB,WI NDYB,VJINDZB, RMACH 
, CPHI W ,XFA, YFA, ZFA, THR,XCG , RMASS,PCAN, Y CAN,XM, YM, ZM,XXI , YY I 

, VSND, SFHI W,HTE, GUE, ALPHA, PHI W, XM AX , TBURN , RH 0, VEL , P S I , TH T , 
PHI,ZC 14),DZC 14) 

COMMON NDI M, I PRI NT, NSTEP, NPRI NT , I COUNT, I RATE# I RATI 0,NDIMF 
DIMENSION OUTC40,30),IOUTC40,4) 

100 FORMAT( F6 .3, 6F8 .2 ) 

101 FORMAT ( F6»3,3F8»2,3F7 .2) 

102 FORMATC F6 »3,8F7 .2) 

103 FORMATC //, 2X, *TIME*, 5X, *U*, 7X, *V*, 7X, *W*, 7X, *XI * , 6X, 

*Y I * , 6X, *HT* ) 

104 FORMAT< //, 2X, *TIME* , 5X, *P*, 7X, *Q*,7X, *R*, 5X, *F'SI *, 4X, *THT*, 
4X,*PHI*) 

105 FORMAT( //,2X,*TIME*, 2X, * ALPHA*# 3X,*PHI W* , 3X, *PHI 1*, 

3X, *?SI 2*, 2X, * PSI 3*,2X,* THT4* , 4X, *EPB*, 3X, *EPBC* ) 

106 FORMATC F6.3,4C5X,I1)) 

107 FORMAT( //,*JET STATES. 1=0N, 0=OFF*,/) 

108 FORMATC //, 2X, *TIME* , 2X, *WYOKE*, 2X, *WCOI L*, 4X, *WGY * , 

4X , *UG Z * , 2X , * PH I 1D*,2X,*PSI2D*) 

200 FORMATC //,* STEP SIZE=*,F6»4, 2X, *1 RATI 0=*, I 2) 

DO 10 I = 1,1 COUNT 

READ ALL THE OUTPUTED VARIABLES. 

10 READC 2, ) COUTCI, J), J= 1 , 27 ) , C I OUTC I , J), J=l,4) 

OUTFUT THESE VARIABLES TO THE TTY IN APPROPRIATE COLUMNS WITH 
HEADINGS. 





PRINT 


103 




DO 1 1 = 


1,1 COUNT 


1 


PRINT 


100, COUTC I, J), J=l,7) 




PRINT 


104 




DO 2 1 = 


1,1 COUNT 


2 


PRINT 


101, OUT C I , 1 ) , C OUT C I , J ) , J=8 , 13) 




PRINT 


105 




DO 3 1 = 


1,1 COUNT 


3 


PRINT 


102, OUTC I , 1 ) , C OUTC I,J),J=14,21) 




PRINT 


108 




DO 5 1 = 


1,1 COUNT 


5 


PRINT 


102, OUTC I , 1 ) , C OUTC I , J) , J=22, 27 ) 




PRINT 


107 




DO 4 1 = 


1,1 COUNT 


4 


PRINT 


106, OUTC I , 1 ) , C I OUT C I , J) , J= 1 , 4 ) 




PRINT 


200, H, I RATI 0 



STOP 

END 
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00010 SUBROUTINE 1 NTEG 

00020 COMMON Y< 9)*DYC 9 ) *X *H* WI NDXB* WI NDYB* Wl NDZB* RMACH 

00030+ *CFHIW*XFA,YFA,ZFA*THR*XCG*RMASS*FCAN*YCAN,XM,YM*ZM*XXI *YYI 



000 40+ * VSND* SPH I W*HTE* GUE* ALPHA* PHI W*XMAX* TBURN* RHO* VEL* FSI * THT* 

00050+ PHI ,Z< 14)*DZ< 14) 

00060 COMMON NDI M* I FRI NT* NSTEP* NPRI NT * I COUNT# I RATE* I RATI 0* NDIMF 

00070* • STORAGE LOCATIONS FOR THE REQUIRED FAST STATE VARIABLES AND 
00080* THEIR DERIVATIVES. ”AUX M FOR Y(I) AND "BUX" FOR Zd>. 

00090 DIMENSION AUX 1< 9)*AUX2< 9)*AUX3< 9)*AUX4( 9)*AUX5C 9 )* 

00100+ AUX6C 9 ) * AUX7 ( 9)*AUX8( 9 ) ,BUX 1 d 4 ) *BUX2 ( 1 4 ) * BUX3 (1 4) * 

00110+ BUX4C 14) *BUX5( 14)*BUX6< 14)*BUX7( 14>*BUX8( 14) 

00120 DATA IENTR/1/* I.ENTRF/2/ 

00140 IF ( I RATE .EG • 1 > GO TO 100 

00150* DECIDE WHETHER TO 1) PREDICT REQUIRED STARTING VALUES BY 
00160* AN EULER BACKSTEP METHOD* 2) PERFORM PREDICTION OF THE Yd) 
00170* VARIABLES DURING INTEGRATION* OR 3) CORRECT THE Yd) VARIABLES 
00180* DURING INTEGRATION. 

00190 IF CIENTR-2) 20*21*22 

00200* DETERMINE REQUIRED STARTING VALUES USING AN EULER BACKSTEF* AND 
00210* STORE INTO APPROPRIATE LOCATIONS. 

00220 20 HS=lfcATIO*H 

00230 H 1 =3 • *HS 

00240 H3=4./3.*HS 

00250 G 1 = 3 • *H 

00260 G3=4./3.*H 

00270 Cl=112./121. 

00280 C2-9./121. 

00290 DO 16 1=1 *NDIM 

00300 AUX2CI )=Y(I )-HS*DY(I ) 

00310 AUX3d )=Yd )-2.*HS*DYd ) 

00320 AUX4CI )=Y(I )-3.*HS*DY(I ) 

00330 AUX6 d)=DYd) 

00340 AUX7d)=DY(I) 

00350 16 AUX8(I )=B. 

00360 DO 26 I=1*NDIMF 

00370 BUX2(I )=Z(I )-H*DZ(I ) 

00380 BUX3CI )=Z(I )-2.*H*DZ(I ) 



00390 BUX4CI )=ZCI )-3.*H*DZ(I ) 

00400 BUX6(I)=DZ(I) 

00410 BUX7 d ) =DZ ( I ) 

00420 26 BUX8 ( I ) =0 . 

00430* PREDICT THE Y(I ) VARIABLES. 

00440 21 DO 17 1 = 1* NDI M 

00450 AUX 1(I)=Y(I) 

00460 AUX5( I ) =DY ( I ) 

00470 DELT = AUX4( I ) +H3*C AUX5 ( I ) +AUX5(I ) -AUX 6 ( I ) +AUX7 < I ) +AUX7 (I ) ) 

00480 Yd ) = DELT-C1*AUX8(I ) 

00490 17 AUX8 d ) =DELT 

00500 I ENTR=3 

00510 GO TO 100 

00520* CORRECT THE Yd) VARIABLES. 

00530 22 DO 18 I=1*NDIM 

00 540 DELT= . 12 5* (9 .*AUX Id) -AUX3C I )+Hl*(DY(I) +AUX5C I ) +AUX5CI ) 

00550+ -AUX6 ( I ) ) ) 

00560 AUX8 ( I ) =AUX8 ( I ) -DELT 

00570 18 Y(I )=DELT+C2*AUX8(I ) 

00580 DO 19 1 = 1* NDIM 

00590 AUX7(I )=AUX6(I ) 

00600 AUX 6(1) = AUX 5(1) 
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00610 AUX 4 C I ) = AUX 3 C I ) 

00620 AUX3C I )=AUX2C I ) 

00630 19 AUX2( I ) =AUX 1(1) 

0064G I ENTR=2 

00650* NOW TO REPEAT FOR THE ZCI) VARIABLES. 

00660* DETERMINE WHETHER TO FREDICT OR CORRECT THE ZCI) VARIABLES. 
00670 100 IF ( I ENTRF.EG .3) GO TO 32 

0068G* FREDICT THE Z(I> VARIABLES. 

00690 DO 27 1=1 >NDIMF 

00700 BUX 1(1) =Z ( I ) 

00710 BUX5C I )=DZ( I ) 

007 20 DELT=BUX4( I ) +G 3* C BUX5 < I )+BUX5C I ) -BUX6C I ) +BUX7 C I ) +BUX7 C I ) ) 

00730 ZCI) =DELT-C 1 *BUX8 ( I ) 

00740 27 BUX8 ( I ) =DELT- 

007 50* UFDATE THE VARIABLE TIME BY *’H’* AFTER.* EACH PREDICTION. 

00760 NSTEP=NSTEF + 1 

00770 X=NSTEP*H 

00780 I FRI NT=0 

00790 I ENTRF=3 

00800 RETURN 

00810* CORRECT THE ZCI) VARIABLES. 

00820 
00830 
00840+ 

008 50 
00860 
00870 
00880 
00890 
00900 

009 10 
00920 
009 30 
00940 
009 50 
00960 



32 DO 28 1 = 1.* NDI MF 

DELT= .125*C9 . *BUX 1 C I ) -BUX3C I ) +G 1 * C DZ C I ) +BUX5C I ) +BUX5C I ) 
-BUX6C I ) ) ) 

BUX8 C I ) =BUX8 C I ) -DELT 

28 ZCI ) =DELT+C2*BUX8 Cl) 

DO 29 1=1 >NDIMF 

BUX 7 C I ) =BUX6 C I ) 

BUX6C I )=BUX5C I ) 

BUX4C I ) =BUX3C I ) 

BUX3C I ) =BUX2C I ) 

29 BUX2C I ) =BUX 1 C I ) 

I ENTRF=2 

I PRI NT= 1 

RETURN 

END 
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10 SUBROUTINE I NTER2< C00, C 1 0, C0 1 , C 1 1 , CB) 

20* PERFORMS A TWO DIMENSIONAL INTERPOLATION BETWEEN THE FOUR CORNERS 
30* OF THE SQUARE C00-C11 AND RETURNS THE ANSWER BY CB . 

40* COMMUNICATIONS WITH SUBROUTINE AERO WHICH CALLS INTER2. 

50* DPHI AND DALPHA ARE THE INTERPOLATION INCREMENTS. 

60 C OMM ON /AER 01 /DPHI, DALPHA 

70 C 1 =C00+ DALPHA* (C10-C00) 

80 C2 = C0 1 +DALPHA* < C 1 1 -C0 1 ) 

90 CB=C 1 +DFHI *<C2-C1> 

100 RETURN 

110 END 
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READY. 

FORTRAN, OLD, SXDF 

READY . 

RUN,M=1 1000 

03/28/73. 17 .05*04 
PROGRAM SXDF 



INPUT H,XMAX, NPRI NT, I RATI 0 
? .0005, 2. ,200, 10 
INPUT XT0,YT0,HTT0,XTD,YTD,HTTD 
? 9000,3000,100,0,0,0 



TIME 


U 


0. 


0 . 


.100 


41.41 


.200 


83.14 


.300 


124.61 


. 400 


157.77 


.500 


166.45 


. 600 


175.92 


. 700 


196.31 


.800 


227.44 


.900 


266.06 


1 . 000 


308 .77 


1 . 100 


353.54 


1.200 


400.89 


1.300 


449 .40 


1.400 


498.01 


1 .500 


552.44 


1.600 


601.57 


1.700 


645.79 


1 .800 


698.37 


1 .900 


749 .20 


2.000 


796.43 



V 


W 


0. 


0. 


0. 


.00 


1 .29 


1 .29 


-9 .71 


-7 .74 


-18.84 


-47 .56 


-20.10 


-114.34 


-36.26 


-150.15 


-47 .88 


-166.24 


-52.29 


-169.56 


-51 .83 


-162.85 


-49 .27 


-150.62 


-45.26 


-136.15 


-39.66 


-1 18.95 


-34.79 


-100.35 


-30.25 


-86.66 


-14.23 


-36.64 


11.12 


37.54 


27.02 


80.41 


16.60 


45.12 


-10.08 


-34.29 


-23.79 


-70.56 



XI YI 



0 . 


0 




.00 


0 




.02 




.02 


.61 




.55 


2.57 


1 


.36 


7.15 


2 


.9 6 


15.35 


5 


.63 


27.98 


9 


.39 


45.23 


14 


.44 


67.10 


20 


.97 


9 3.59 


29 


.04 


124.68 


38 


.69 


160.36 


49 


.92 


200.65 


62 


.74 


245.59 


77 


.16 


295.19 


93 


.24 


349 .48 


110 


.87 


408.31 


129 


.98 


471.48 


150 


.43 


539.20 


172 


.30 


611.76 


195 


.74 



HT 

0 . 

2.07 

8.29 
18.68 
33.11 
50.89 
71 .00 
91.98 
1 12.76 
132.50 
150.66 
166.91 
181.18 
193.53 
204.17 
213.61 
222.88 
233.29 
245.71 
259 .58 
273.45 
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TIME 


P 


G 


R 


PSI 


THT 


FHI 


0. 


0. 


0. 


0. 


0. 


90.00 


0 . 


• 100 


0 . 


0 . 


0 . 


0 . 


90.00 


0 . 


.200 


0 . 


- .52 


.52 


45.00 


89.32 


45.00 


.300 


0 . 


- 2.43 


1 .31 


41.34 


77.76 


41 .40 


. 400 


0 . 


- 4.24 


-.16 


18.61 


59.74 


20.22 


. 500 


0 . 


- 3.25 


1.12 


1 1 .62 


35.64 


14.61 


. 600 


0 . 


-1 .80 


1 .03 


14.15 


20.65 


1 . 5.77 


.700 


0 . 


- 1 . 00 


.64 


16.17 


1 1 .83 


16.32 


• 800 


0 . 


-.53 


.19 


17.03 


6.90 


16.46 


.900 


0 . 


-.25 


.23 


17 .59 


4.18 


16.52 


1 • 000 


0 . 


-.23 


.03 


17 .90 


2.58 


16.54 


1 .100 


• 0 . 


-.15 


.11 


18.13 


1 .45 


16.55 


1.200 


0 . 


. 1 1 


.09 


18.23 


1.12 


16.55 


1.300 


0 . 


-.10 


.07 


18 .40 


1 .03 


16.55 


1.400 


0 . 


.26 


-.06 


18.39 


.92 


16.55 


1.500 


0 . 


1.16 


-.39 


18.30 


5.77 


16.54 


1.600 


0 . 


1.15 


-.40 


17.99 


13.22 


16.49 


1.700 


0 . 


.17 


-.09 


17 .68 


17.58 


16.41 


1 .800 


0 . 


-.98 


.31 


17.66 


14.66 


16.40 


1 .900 


0 . 


-1 .07 


.37 


17 .90 


7.83 


16.45 


2.000 


0 • 


.02 


.01 


18.12 


4.35 


16.47 



TIME 


ALPHA 


PHI W 


PHI 1 


PSI 2 


PSI 3 


THT 4 


EPB 


EPBC 


0 . 


0 . 


0 . 


71.57 


89 .40 


0 . 


0 . 


.00 


.00 


• 100 


0 . 


0 . 


71.54 


89.28 


.13 


.00 


.03 


.13 


.200 


1.25 


45.00 


71.57 


88.88 


-.02 


-.04 


.05 


.04 


.300 


5 . 69-128 .55 


71.86 


78.33 


-.10 


-.17 


.03 


• 18 


• 400 


17 . 96 - 158.39 


70.92 


59 .40 


-.10 


.80 


.03 


.81 


.500 


34 . 90 - 1 7 , 0 .03 


64.24 


36.08 


-.16 


.32 


.02 


.35 


• 600 


41 . 28 - 166.42 


62 . 46 


21 .07 


-.18 


.09 


.02 


.21 


.700 


41 . 39 - 163.93 


62.35 


12.18 


-.19 


-.10 


.02 


.20 


.800 


37 . 96 - 162.86 


62.43 


7.30 


-.20 


.02 


.03 


.19 


.900 


32 . 71 - 162.35 


61 .75 


4.64 


-.16 


-.04 


.03 


.19 


1.000 


27 . 17 - 161 .89 


62.99 


3.10 


-.17 


.02 


.01 


.16 


1 .100 


22 . 09 - 161 .61 


62.93 


2.03 


-.16 


-.02 


.01 


.15 


1.200 


17 . 37 - 161 .56 


62.97 


1 .59 


.06 


-.05 


.04 


.08 


1.300 


13 . 30 - 160.88 


63.01 


1 .67 


-.10 


-.26 


.03 


.25 


1.400 


10 . 44 - 160.75 


63.05 


1 .51 


.06 


-.19 


.03 


.22 


1.500 


4 . 07 - 158 .77 


63.43 


6.23 


.20 


-.97 


.02 


.98 


1.600 


3.72 


16.50 


71.49 


13.76 


.23 


.02 


.03 


.24 


1 .700 


7.48 


18.57 


71.23 


18 .22 


.21 


.02 


.02 


.22 


1 .800 


3.94 


20.20 


70.80 


15.76 


-.16 


.09 


.02 


.17 


1 .900 


2 . 73 - 163.62 


69.92 


9 .06 


-.17 


.04 


.03 


.19 


2.000 


5 . 34 - 161.37 


69.50 


5.64 


-.15 


.00 


.03 


.15 
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TIME 


WYOKE 


WCOIL 


WGY 


WGZ 


PHI ID 


PSI 2 D 


0. 


0 . 


0. 


0. 


0. 


0. 


0. 


.100 


-.02 


.03 


. 02 ' 


.03 


-.02 


.03 


.200 


. 00 


. 19 


-.06 


-.01 


.00 


- .48 


.300 


. 10 


- .02 


.01 


-.02 


.10 


- 2.73 


. 400 


-.81 


.06 


- .03 


.02 


-.81 


- 3.90 


.500 


- .70 


.02 


.01 


.04 


-.70 


- 3.39 


. 600 


-.03 


.03 


• 01 


.03 


-.03 


- 2.04 


.700 


.20 


- .01 


.01 


-.01 


.20 


-1 .20 


.800 


-.03 


-.01 


- .04 


-.02 


-.03 


-.57 


.900 


.21 


.06 


-.10 


.04 


.21 


-.27 


1.000 


-.16 


.03 


-.09 


.00 


••16 


-.19 


1 . 100 


-.01 


.00 


.01 


.01 


-.01 


-.18 


1 .200 


-.01 


-.04 


- .04 


- .01 


-.01 


.02 


1.300 


-.01 


-.01 


.02 


.01 


-.01 


-.13 


1.400 


-.01 


-.07 


-.04 


.03 


-.01 


.20 


1.500 


1.60 


.00 


-.01 


-.03 


1 .60 


1 .22 


1.600 


- . 08 


-.02 


-.03 


.05 


-.08 


1 .20 


1 .700 


-.03 


- . 00 


-.04 


- .02 


-.03 


.19 


1 .800 


-.07 


.02 


-.06 


.01 


-.07 


- 1.01 


1 .900 


-.54 


.05 


-.03 


.05 


-.54 


- 1.08 


2.000 


-.14 


-.07 


-.03 


.05 


-.14 


-.05 



JET STATES 


. 1 


= 0 N , 0 = 


OFF 




0 . 


0 


0 


0 


0 


. 100 


0 


0 


0 


0 


.200 


0 


0 


1 


1 


.300 


0 


1 


1 


0 


.400 


0 


0 


1 


1 


.500 


1 


0 


0 


1 


. 600 


0 


1 


1 


0 


.700 


0 


1 


1 


0 


.800 


0 


0 


1 


1 


.900 


0 


1 


1 


0 


1 .000 


0 


0 


1 


1 


1 .100 


0 


1 


1 


0 


1.200 


0 


1 


1 


0 


1.300 


0 


1 


1 


0 


1.400 


0 


0 


0 


0 


1.500 


0 


0 


0 


0 


1.600 


0 


0 


0 


0 


1.700 


0 


0 


0 


0 


1 .800 


0 


0 


0 


0 


1 .900 


0 


0 


0 


0 


2.000 


0 


0 


0 


0 



STEP SI ZE = .0005 I RATI 0=10 
STOP . 
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APPENDIX B 
PROGRAM VARIABLES 



The following is an alphabetical listing of the computer program variables 
except for the variables in subroutine SEEKER. 



ALPHA 

ALPHAE 

AUX 1 
• 

AUX 8 
BUX 1 

BUX 8 

Cl, C2 

COO, CIO 
C01, Cll 

CB 

CL 

CM 

CMP 

CMPB 

CN 

CNP 

CNPB 

CONI 



Missile angle of attack 

Angle of attack entry argument for coefficient table lookup 

Storage locations for integration routine used for HS . 

Y^, ^i_ 2 ’ Y i_ 3 ’ DY^, UY^ DY^ truncation corrector 

respectively 



Storage locations for integration routine used for H. 

Z . , Z. n , ^ > Zf 3 , DZ . , DZ. , , DZ. truncation corrector 



1' i -1 

respectively 






"i-2 ’ 



Intermediate answers for 2-D coefficient lookup 
Entry points for 2-D coefficient lookup 



Coefficient value return by 2-D coefficient lookup 

Aerodynamic total rolling moment coefficient in body fixed axes 

Aerodynamic total pitching moment coefficient in body fixed axes 

Aerodynamic total pitching moment coefficient in pitch axes 

Array of pitching moment coefficient for baseline missile (no 
JRC) vs a and $ 

w 

Aerodynamic total yawing moment coefficient in body fixed axes 

Aerodynamic total yawing moment coefficient in pitch axes 

Array of yawing moment coefficient for baseline missile (no 
JRC) vs a and $ 

W 

Program constants 



CONU 

CP 

CPE 

CFHI1 

CPHIW 

CX 

CXB 

CY 



Dummy variable 

Vector of cosines of for each engine 

Cos ($_!_) 

Cos (fy) 

Aerodynamic total X force coefficient in body fixed axes 

Array of X force coefficient for baseline missile (no JRC) 

vs ot and $ . 

w 

Aerodynamic total Y force coefficient in pitch axes 
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CYP 

CYPB 

CZ 

CZP 

CZPB 

DALPHA 

DELT 

DIA 

DPHI 

DY 

DZ 

EO 

E3 

EOD 

♦ 

E3D 

EPB 

EPBC 

EPBCO 

EPS 

Gl, G3 

GRAV 

HI, H3 

H 

HS 

HT 

HTD 

HTMT 

HTTO 

HTTD 

HTTI 

IA 



Aerodynamic total Y force coefficient in body fixed axes 

Array of Y force coefficients for baseline missile (no JRC) 
vs a and $ 

w 

Aerodynamic total Z force coefficient in body fixed axes 

Aerodynamic total Z force coefficient in pitch 

Array of Z force coefficients for baseline missile (no JRC) 
vs a and $ 

w 

The residule of a required for 2-D coefficient lookup 
Intermediate variable in integration routine 
Missile diameter 

The residule of required for 2-D coefficient lookup 

Vector of derivatives of Y 
Vector of derivatives of Z 
Quaterion variables 



Derivatives of E0-E3 



Angular error between gyro spin axis and target line of sight 
in radians 

Angular error between coil housing axis and target line of 
sight in radians 

EPBC in degrees for outputting 

Error due to non-orthogonality of E0-E3 

Internal constants for integration routine 
2 

Gravity in ft /sec 

Internal constants for integration routine 
Step size for fast integration routine 
Step size for slow integration routine 
Altitude of missile 
Derivative of HT 

Altitude difference between missile and target 
Initial height of target 
Target climb rate 
Altitude of target 

Entry location on a for 2-D coefficient lookup 
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ICOUNT 

IENTR 

IENTRF 

IJET 

IOUT 

IP 

IPRINT 

IRATE 

IRATIO 

IRT2 

NDIM 

NDIMF 

NPRINT 

NSTEP 

OUT 

P 

FCAN 

PD 

PHI 

PHI1 

PHIIO 

PHI1D 

PHIE1 

PHIJ 

PHIW 

PHIWT 

PHIWTE 

PRMT 

PRMTY 

ERMTZ 

PSI 

FSI2 

PS 120 

PSI2D 

PS 13 



Number of times outputting is performed 

1 — Calculate required starting values, 2--Predict Y(l) for 
integration, 3 — Correct Y(l) for integration 

2 — Predict Z(l) for integration, 3 — Correct Z(l) for integration 
Array for each jet; 0--off, l--on 

Array for outputting interger variables 

Entry location on for 2-D coefficient lookup 

0 — No outputting permitted, 1 — Outputting permitted 

Controls integration routine; 0--Integrate both Y and Z, 1--Integrate 
only Z 

HS/H 

2* IRATIO 
Dimension of Y(l) 

Dimension of Z(l) 

Outputting interval = NPRINT*H 
Counter for number of H integration steps 
Array for outputting real variables 
Missile roll rate in body axes in rad/sec 
Pitch canard deflection 
Derivative of P 
§ in degrees 
in radians 

PHI1 in degrees for outputting 

Derivative of PHI1 

for thruster number 1 

for thruster in degrees 
d 

^ in degrees 

^ reduced to a range of 0 - 9° degrees 
entry argument for coefficient table 
Dummy variable 

Control function for JRC's aligned with 
Control function for JRC ' s aligned with 
Y in degrees 
Y 2 in radians 

Y 2 in degrees for outputting 
Derivative of PSI2 
in radians 



lookup 

missile Y axis 
missile Z axis 
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PS 130 
PSI3D 

Q 

QD 

QUE 

R 

RD 

RHO 

RKM 

RKMB 

RKN 

RKNB 

RKY 

RKYB 

RKZ 

RKZB 

RMACH 

RMASS 

RMASSO 

RMASSD 

S 

SIGA 

SIGAD 

SIGB 

SIGBD 

SP 

SFE 

SPHI1 

spmw 

Til 

T33 

TBJRC 

TBURN 

THT 

THT4 



in degrees for outputting 
Derivative of PS 13 

Missile pitch rate in body axes in rad/sec 
Derivative of Q 

Dynamic pressure -^pV^ in lbs/ft^ 

Missile yaw rate in body axes in rad/sec 
Derivative of R 

O 

p in slugs /ft 0 

Total moment amplification factor along missile Y axis 
Array of moment amplification factor vs a and $ 

Total moment amplification factor along missile Z axis 
Array of moment amplification factor vs a and $ T 
Total force amplification factor along missile Y axis 
Array of forces amplification factor vs a and $ T 
Total force amplification factor along missile Z axis 
Array of forces amplification factor vs a and 
Mach number of missile 
Instantaneous missile mass 
Initial missile mass 
Derivative or RMASS ^ 

Missile reference area = 
ct a in degrees 
Derivative of SIGA 
Og in degrees 
Derivative of SIGB 
Dummy variable 

Vector of sines of for each engine 
Sin 

Sin (§ w ) 

Elements of matrix transformation from body to inertial axes 



Burn time of JRC's 

Burn time of missile main thruster 

0 in degrees 

0^ in radians 
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THR 


Main thruster thrust 


tht4o 

tht4d 


9^ in degrees for outputting 
Derivative of THT4 


TJRC 


Thrust of one JRC 


TSJRC 


Enable time for JRC ' s 


U 


U velocity of missile 


UD 


Derivative of U 


UT 

V 


U T 

V velocity of missile 


VD 


Derivative of V 


VEL 


Total missile velocity 


VEL1 


Dummy variable 


VEL2 


Dummy variable 


VSND 


Velocity of sound 


VT 

W 


V T 

W velocity of missile 


WCZ 


Q of seeker cage along Z axis 


WGY 


Q of seeker gyro along Y axis 


WGZ 


Q of seeker gyro along Z axis 


WZNTKB 

• 


Components of wind along missile body axes 


• 

• 

WINDZB 

WINTKI 

• 

• 


Components of wind along inertial axes 


WINDZI 

WT 

X 


w T 

Time 


XCG 


Position of missile C.G. relative to aerodynamic reference point 


XCGO 


Initial XCG 


XCGD 


Derivative of XCG 


XF 


Total force along X axis 


XFA 

XFB 


Total aerodynamic force along X axis 

Total aerodynamic force along X axis for baseline missile (no JRC 


XI 


Inertial X position of missile 


XID 


Derivative of XI 


XIMT 


Inertial X position of target relative to missile 


XJET 


Position of JRC's from aerodynamic reference point 
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XM 

XMAX 

XMB 

XME 

XMTD 

XTO 

XTD 

XTI 

XXI 

XXIO 

XXID 

Y 

YCM 

YF 

YFA 

YFB 

YFJ 

YI 

YID 

YIMT 

YM 

YMB 

YMJ 

YMT 

YMTD 

YTO 

YTD 

YTI 

YYI 

YYIO 

YYID 

Z 

ZF 

ZFA 



Total moment along X axis 
Total run time 

Total moment along X axis for baseline missile (no JRC) 

X position of target relative to missile in body axes 

Derivative of XMT 

Initial XTI 

Derivative of XTI 

Inertial X position of target 

I XX 

Initial XXI 
Derivative of XXI 

Vector of slow integration state variables 
Deflection of yaw canard 
Total along Y axis 

Total aerodynamic force along Y axis 

Total aerodynamic force along Y axis for baseline missile (no JRC) 
Total force along Y axis due to JRC's 
Inertial Y position of missile 
Derivative of YI 

Inertial Y position of target relative to missile 
Total moment along Y axis 

Total moment along Y axis for baseline missile (no JRC) 

Total moment along Y axis due to JRC's 

Y position of target relative to missile in body axes 

Derivative of YMT 

Initial YTI 

Derivative of YTI 

Inertial Y position of target 

I YY 

Initial YYI 
Derivative of YYI 

Vector of fast integration state variables 
Total along Z axis 

Total aerodynamic force along Z axis 
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ZFB 

ZFJ 

ZM 

ZMB 

ZMJ 

ZMT 

ZMTD 



Total aerodynamic force along Z axis for baseline missile (no JRC) 
Total, force along Z axis due to JRC's 
Total moment along Z axis 

Total moment along Z axis for baseline missile (no JRC) 

Total moment along Z axis due to JRC ' s 
Z position of target relative to missile in body axes 
Derivative of ZMT 
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